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SUMMARY 


The research described here was concerned with designing 
a control system for a vehicle with a heat engine and a con- 
tinuously variable transmission. The objectives of control 
were to minimize fuel consumption and to achieve satisfactory 
dynamic response of vehicle variables as the vehicle was driven 
over a standard driving cycle. This is the first time that a 
control system design and evaluation has been attempted for 
this overall vehicle system. Even though the vehicle system 
was highly nonlinear, attention was restricted to linear control 
algorithms which could be easily understood and implemented on- 
board using a microcomputer. The effectiveness of these con- 
trollers in producing good dynamic behavior of the vehicle as 
well as minimum fuel consumption was demonstrated by simulation. 
Simulation results also revealed that the vehicle could exhibit 
unexpected dynamic behavior which must be taken into account in 
any control system design. 
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1.0 INTRODUCTION 


An Important current area of research Involves the design 
and development of vehicles and vehicle components which will 
reduce the nation's unduly high dependence on Imported petroleum. 
The Continuously Variable Transmission (CVT) , whose ratio may 
take on any value within a certain range, is one component which 
may be used to ensure that the vehicle's engine is operated 
efficiently with respect to fuel consumption. The research de- 
scribed here was directed toward investigating the control 
problems associated with controlling the throttle and trans- 
mission ratio of a vehicle containing a CVT so that acceptable 
stable dynamic responses for all important vehicle variables are 
obtained while minimizing fuel consumption. 

The vehicle under consideration is a 1,500 Kg conventional 
sedan with a six cylinder engine and a continuously variable 
transmission. The system is inherently nonlinear because the 
torque and speed relationships include the transmission ratio 
in a multiplicative form, the relationships among engine vari- 
ables are nonlinear, and the vehicle aerodynamic drag and rol- 
ling resistance are functions of the square of the velocity. 

The presence of these nonlinearities significantly complicates 
the control system analysis and design. The work described 
here involves development of simplified models for the components 
of the system, the design of control systems to achieve the 
desired objectives and analysis of the closed-loop performance 
using digital simulation. 
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1.1 Previous Work 

Several researchers have investigated ways to minimize 
energy consumption or maximize efficiency in a vehicle propulsion 
system [1,2,3,4,6,7,8,91. Some of this work considered energy 
savings for the combination of a power plant and CVT (2,4,61 
with little regard for overall control considerations, and some 
work focused on the design of control systems for this con- 
figuration when augmented by a flywheel [5,7,81. In fact, there 
is little previous work which was directed toward the design of 
control systems for configurations which include a CVT but not 
a flywheel (4,8,91, and none of this work considered the com- 
plete vehicle system including drive train and road losses with 
evaluation of the control systems for a standard driving cycle. 

1.2 Study Objectives 

The objective of this research was to investigate control 
problems associated with the control of a vehicle containing a 
heat engine and a continuously variable transmission. The 
objective was to design control systems which would operate the 
vehicle so that (i) the heat engine is operated at the minimum 
energy consumption point for any particular demanded torque and 
speed, and (li) the overall system is operated with minimum 
energy consumption for a. standard driving cycle. 

It is important to note that this investigation, for the 
first time, had the objective of considering the overall problem 
of controlling a vehicle with CVT while the vehicle is subject 
to a driving regime prescribed by a standard driving cycle; all 
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of the major elements of vehicle dynamics were Included so that 
the control of the entire vehicle system was examined. 

An Important aspect of the objectives for this work was a 
determination to take an approach which would lead to easily 
implementable controllers. Some considerations leading to this 
approach are: 

1. It Is not possible to derive control algorithms 
for this system without undue simplifications 
because of Its high degree of system nonlinearity. 

It Is also not desirable to derive such controls 
because, In general, they would be In a form which 
would be difficult to implement. 

2. Any derivation and calculation of optimal con* 
trols would necessarily be tied to a particular 
driving cycle, and the controls would be open 
loop. The results desired here (although to be 
evaluated with respect to a particular driving 
cycle) were not to be dependent upon any parti- 
cular cycle. 

3. It was desirable to devise control algorithms for 
this system which would be in a relatively simple, 
feedback form so that they cculd be Implemented 
easily in a small. Inexpensive, onboard micro- 
computer . 

As a result of taking this approach, it was decided to use 
a control approach which was directed toward designing linear 
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control loops (or algorithms) which use signals obtainable from 
vehicle sensors. As a result of this decision, more specific 
control objectives were defined. These objective* were to 
determine the appropriate types of linear controllers for three 
control loops which control the engine speed, throttle, and CVT 
ratio, and to optimize the parameters of these controllers. 

Section 2 deals with a description of the vehicle and 
development of its models while Section 3 describes the details 
of the approach used to design the control system. An overview 
of the simulation is given in Section 4, with simulation results 
discussed in Section 5. Conclusions and future work are dis- 
cussed in Section 6. 


2.0 VEHICLE DESCRIPTION 


The vehicle used in this study is a conventional sedan with 
a six cylinder engine. However, the transmission employed is 
a continuously variable transmission (CVT). In the subsections 
below, we outline the methods used to model the vehicle and 
the drive train components, and we present the equations which 
describe the dynamic behavior of the overall system. A more 
detailed description of these models and a detailed derivation 
of the system state equations are given in Appendix A. 

2.1 Vehicle Modeling 

The propulsion system of the vehicle consists of an internal 
combustion or heat engine (HE) coupled to a continuously variable 
transmission; the CVT, in turn, delivers power to a differential 
which connects the drive shaft to the rear axle. The overall 
arrangement is shown in Figure 2.1. The method of modeling 
each component in the drive train is discussed in the para- 
graphs below. 



Power to 
Rear Wheels 


Figure 2.1 Drive Train Configuration 
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Heat Engine (HE) Model : The HE is modeled as a rotating 

inertia with an applied torque. The applied engine torque is 
the output of a first order low pass system whose input is a 
torque determined from an engine map. For a given engine 
speed and throttle setting, the engine map determines a steady 
state engine torque. This torque in turn is the input to the 
first order system whose output is the engine torque actually 
developed. The first order system (with a time constant of 
1.0 second) approximates the dynamics of the throttle linkages 
and engine combustion characteristics (a step change in throttle 
does not produce a step change in developed engine torque) . 

See Figure 2.2. 



Figure 2.2 Heat Engine Configuration 


Continuously Variable Trtinsmission : The CVT is modeled 

as a ratio (which is defined to be the ratio of drive shaft 
speed to engine speed, and this is allowed to vary continuously 
from zero to infinity) , an inertia and a fixed efficiency as 
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shown in Figure 2.3. The inertia is defined to be the equivalent 
CVT inertia as seen on the drive shaft side of the transmission. 
It was also assumed that there are second order dynamic effects 
associated with changing the ratio, i.e. if there is a step 
change in the variable which controlled the ratio, the actual 
ratio will respond with a second order response. This is also 
shown in Figure 2.3. Finally, we note that since the CVT ratio 
can be set to zero, no clutch is required between the HE and 
CVT. 

Differential : The differential is modeled in exactly the 

same way as the CVT except that the ratio is fixed. The ratio 
is defined as the ratio of axle speed to drive shaft speed. 

Vehicle Body : The model of the vehicle body and wheels 

takes into account the weight of the vehicle and payload, 
aerodynamic drag, rolling resistance and grade. 

A detailed description of all the above models and how 
they are used to derive the differential equations which de- 
scribe the overall vehicle dynamics is given in Appendix A. 
Appendix B contains the actual parameter values employed when 
simulating the system. 

2.2 System Differential Equations 

As described in Appendix A, there are four states which 
characterize the dynamic behavior of the overall vehicle system: 

x^ - Engine speed. 

X£ * Developed engine torque. 
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* CVT ratio. 

x^ » Rate of change of CVT ratio (“x^) . 



Figure 2 . 3 CVT Model 

Since there is essentially no slippage between the engine and 
the rear wheels, the speed of the drive shaft and rear axle, 
as well as the vehicle velocity, can be computed from the engine 
speed, x^. Also, since there is assumed to be a first order dy- 
namic between a change in throttle setting and the corresponding 
change in developed engine torque, the latter, X 2 , is also a 
state. Finally, since the CVT model includes a second order 



-9- 


response of ratio to a change in the variable which controls 
the ratio, x 3 and x 4 are required states from the CVT model. 
The four state equations which describe the vehicle dy- 


namics are derived in Appendix A and are given as 

■ [*2 ” ^ ^2 ^ ^A^W x l x 4^ 1 / (Jj; ^ ^T®A (2.2) 

x 2 * “1*2 " ♦3( x i» u i)l / t l (2.3) 

x 3 - x 4 (2.4) 

x 4 - C x x 4 +C 2 x 3 + C 3 u 2 (2.5) 


where 


4» 1 (x 1 ,x 3 ) - ID(x 1 ,x 3 ) + R(x lt x 3 )l /MjK^ ICj 

*2 * r a (t b + ¥ 8in )/m t k a k t 

«t - <V r aV + < r a VW + < r a VVW 

My - (W/g) + 

and where u^ is throttle setting, ^(x^up is the steady state 
engine torque determined from the engine map (a function of 
throttle setting and engine speed) , is the time constant of 
the throttle linkage/engine dynamic response, W is the vehicle 
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weight, g is the acceleration of gravity, D and R are the 
aerodynamic drag and rolling resistance forces, respectively 
(both functions of x^), 6 is the grade angle, Ry is the wheel 
radius, Tg is the braking torque, J E , J w . J T and J A are the 
rotating inertias of the engine, all four wheels, the CVT and 
the differential, respectively, K A and Kj are the efficiencies 
of the differential and the CVT, respectively, R A is the dif- 
ferential ratio, Cp C2and C3 are constants used to characterize 
the second order dynamic response of the ratio changing mechanism, 
and u£ is the variable used to produce a change in the ratio 
(this variable will be generated by a ratio controller which is 
discussed in the next section) . The vehicle velocity, v, can 
be computed from the above states by 

v - ^^*1X3 (2.6) 


(throttle) 


U2 (ratio actuator) 


VEHICLE 

SYSTEM 


x^ (engine speed) 
^ x 2 (engine torque) 
^ Xj (CVT ratio) 

->» x, (rate of charge 
of CVT ratio) 


Figure 2.4 Block Diagram of Vehicle System 
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We note that two of the above state equations are highly 
nonlinear ((2.2) and (2.3)), thus complicating the control 
system design. A block diagram of the overall vehicle system 
showing the states and inputs is shown in Figure 2.4. The 
control inputs, and U2» will be generated by the vehicle 
control system. Having described the characteristics of the 
system to be controlled, we now turn to a discussion of the 
design of the control system. 



3.0 CONTROL SYSTEM DESIGN 


The purpose of this section is to present the overall con- 
trol philosophy for the vehicle system described in Section 2.0 
and Appendix A, and to discuss the details of the control sys- 
tem designed to achieve the objectives which follow from this 
philosophy. 

3.1 Control Objectives and Approach 

The overall control objective is to manipulate throttle 
setting and CVT ratio changing input so that the vehicle achieves 
minimum fuel consumption while being J ven over a standard 
driving cycle. An examination of a typical engine map shows 
that for each throttle setting there is an engine speed which 
achieves minimum fuel consumption for that throttle setting. 

In particular, a Minimum Fuel Curve can be developed from such 
a map which plots minimum fuel consumption engine speed against 
throttle setting. Such a curve (which is the one actually used 
in this study) is shown in Figure 3.1. 

The existence of a minimum fuel consumption engine speed 
for each throttle setting suggests a specific control approach 
to achieve minimum fuel consumption: manipulate the throttle 
so that the vehicle follows the velocity requirements of the 
driving cycle, and, for each throttle setting, manipulate the 
CVT ratio so that the engine runs at a minimum fuel consumption 
speed for that throttle setting. The primary objective of 
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Figure 3 . 1 Minimum Fuel Curve 
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Chls study was to explore the feasibility of controlling the 
vehicle system in this manner. A block diagram of the control 
approach is shown in Figure 3.2. 

3.2. Control System Design 

In designing a control system to accomplish the task de- 
scribed above, an emphasis was placed on using simple, standard 
controllers which could be easily implemented. The use of 
linear control design methods for the design of these control- 
lers was ruled out because of the highly nonlinear nature of 
the vehicle dynamics (see equations (2.2), (2.3), (2.6)). An 
additional nonlinearity is introduced by the minimum fuel curve 
which determines the engine speed set point for each throttle 


Desired 



Figure 3 . 2 Vehicle Control Approach 
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setting (see Figures 3.1 and 3.2). This curve is a nonlinear 
function of throttle setting, thus introducing a significant 
nonlinearity in the vehicle velocity control loop. 

An additional important factor in the design of the con- 
trollers is that they should use only easily measured system 
variables in a feedback configuration. For a given driving cycle, 
it is conceivable that using optimal control theory, open-loop 
trajectories for throttle setting and the ratio changing input 
could be generated to achieve minimum fuel consumption. However, 
they would not be practical to Implement because of inaccuracies 
in the vehicle models used to generate them, and because in 
practice a vehicle would not be driven over the specific driving 
cycle they were designed for. Thus, some form of feedback con- 
trol is required in an actual vehicle; hence the use of feedback 
control in this study. 

The control system employes two primary control loops: one 
to control vehicle velocity by manipulating throttle, and the 
other to control engine speed by manipulating CVT ratio. This is 
shown in Figure 3.3. It is assumed that the operator of the 
vehicle generates a signal (by manipulating a pedal or some 
other device) which represents the desired vehicle velocity. 

This signal is the set point to the velocity control loop as 
shown in Figure 3.3. Based on the velocity error, the velocity 
controller generates a throttle setting and a braking torque to 
make the vehicle velocity equal the set point (idle throttle 
during braking and zero braking torque when throttle is above idle) . 



sired Velocity from 



Figure 3.3 Vehicle Control Svsten - Initial Configuration 
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For the given throttle setting, u^, the minimum fuel curve 
generates an engine speed set point (for minimum fuel con* 
sumption) which is enforced by the engine speed controller mani- 
pulating the CVT ratio. 

There are two possible ways of envisioning how the engine 
speed controller can change the CVT ratio. First, the output of 
the controller could be U 2 , the variable which drives the ratio 
changing mechanism. Alternatively, the output of the engine 
speed controller could be a ratio set point which drives a ratio 
control loop; the ratio controller compares actual ratio to de- 
sired ratio and generates the input, U 2 , to the ratio actuator 
(see Figure 3.3). This alternative allows the ratio controller 
to be selected to speed up, if necessary, a sluggish ratio 
changing mechanism. This second approach was the approach adopted 
in the present study. 

The overall control system thus consists of three control 
loops : a velocity loop, an engine speed loop and a ratio loop. 

In addition, simulation runs showed that an improvement in con- 
trol could be obtained by placing two low pass filters in the 
system; one to smooth out throttle changes and the other to 
smooth out changes in desired engine speed. The next three 
subsections describe the design of the controllers for each of the 
three control loops and the placement and design of the two low 
pass filters. 
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3.3 Vehicle Velocity Controller Design 

The job of the vehicle velocity controller is to manipulate 
the throttle and brakes so that the vehicle velocity equals the 
velocity set point (driving cycle velocity) . The input to the 
controller is the velocity error and, in keeping with the design 
objective of using simple, standard controllers, the controller 
is assumed to be a proportional plus integral (PI) controller. 
This is a natural choice because it represents how an actual 
operator would manipulate the throttle in response to a velocity 
error. In particular, an operator would depress the throttle 
in proportion to the velocity error; as the vehicle came up to 
speed and the error decreased, the operator would back off on the 
throttle, hence the need for the proportional term. An integral 
term is also needed to keep the throttle depressed at the value 
necessary to achieve zero steady state velocity error; without 
the integral term the throttle would approach idle position as 
the velocity error approached zero and a nonzero steady state 
velocity error would result. 

Since the controller contains an Integral term, and the 
actuator it is driving can limit (throttle has an upper limit 
of 1007.) , it is necessary to incorporate an antiwindup feature 
in the controller. The antiwindup feature essentially inhibits 
additional corrections to the throttle if the throttle is at 
its limit, and prevents the integrator in the PI controller 
from saturating or "winding up". The details of this feature 
are discussed in Appendix D. 




¥ 
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Final ly, later simulation runs revealed that rapid changes 
in the throttle at start-up (more rapid than an actual driver 
could produce) could cause instability in the vehicle velocity. 

It was found that smoothing of the throttle controller output 
reduces this possibility; hence a first order low pass filter 
was added at the output of the throttle controller. 

A block diagram of the throttle controller is shown in 
Figure 3.4. The PI control algorithm, the antiwindup logic and 
the filter generate what might be considered a pedal position, P. 

A pedal position of (see blocks labeled throttle and brake 
limiter in Figure 3.4) corresponds to idle throttle. If the pedal 
is below the throttle limiter sets the throttle at idle 
position and the brake limiter generates a braking torque pro- 
portional to pedal position. For a pedal position between 
and 100 the braking torque is zero and the throttle equals the 
pedal position. For a pedal position above 100, the throttle 
is limited to 100%. The braking torque and throttle position 
are inputs to the vehicle dynamic simulation and the throttle 
setting U| is also an input to the minimum fuel curve (see 
Figure 3.3). This curve generates a set point for the engine 
speed control loop such that the engine runs at its minimum 
fuel consumption speed for tr.e particular throttle setting. 

Referring to Figure 3.4, the transfer function for the PI 
algorithm can be expressed as (ignoring the effects of the anti- 
windup logic) . 


M(s) K VP 8 + ^I 
V e (s) “ s 


(3.1) 


P miliqw 
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Figure 3 . A Velocity Controller 
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where K^p and are the proportional and integral gains, 
respectively. If we define the controller state as (x^ is used 
in conjunction with the engine speed controller) 

■ m - KypCvjj-v) (3.2) 

Then using (2.6) the controller state and output equations can 
be expressed as 

x 6 * *VI^ v D ~ R A*W X 1 X 3^ (3.3) 

and 

m " x 6 + K VP^ v D * ®A^W X 1 x 3^ (3.4) 


The transfer function of the throttle filter can be written 
as 


M(s) T t 3+1 


(3.5) 


where t t is the filter time constant. If we define the filter 
state as 

Xy » P (3.6) 


then using (3.4) and (3.5) the filter state equation is 


*7 



Kim 

- *7> + — <V D * R A «V *1 x 3> 


(3.7) 


Equations (3.3), (3.6) and (3.7) describe the overall dynamic 
behavior of the throttle controller. It is important to note, 
however, that these equations only apply to the case where the 
actuator is not at a limit and the antiwindup logic has no 
effect on the controller output. 
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3.4 Engine Speed Controller Design 

The Job of the engine speed controller is to change the CVT 
ratio so that for a given throttle setting, the engine runs at 
its minimum fuel consumption speed. This is shown in Figure 3.5. 
The control algorithm was chosen to be a PI algorithm (the 
integral term is used to produce zero steady state error to a 
constant desired engine speed) with an antiwindup feature (the 
ratio has a lower limit of zero and the controller contains 
an integral term. See Section 3.2 and Appendix D) . As discussed 
in Section 3.1, the output of the engine speed controller is a 
ratio set point R^, which is implemented by the ratio control 
loop. 

Simulation studies showed that the nonlinearity of the 
minimum fuel curve could produce instabilities in the control 
system. In particular, the curve (Figure 3.1) changes to a 
steep slope (large gain) for throttle settings above 45%; it 
was found that when the throttle made the transition from the 
low to high gain portions of the curve, the vehicle velocity 
could begin to oscillate. This instability was due, in part, 
to a rapid change in the engine speed set point. To slow 
down this rapid change, a low pass filter was placed immediately 
after the minimum fuel curve as shown in Figure 3.5. With the 
addition of this filter, the engine speed controller does not 
control to exactly the minimum fuel engine speed. However, it 
is unrealistic to expect the engine speed controller to follow 
rapid variations in desired engine speed; what is desirable is 
to track more gradual changes in optimum engine speed. Hence, 
the control loop controls to rather than co^. 
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The transfer function for the PI algorithm can be expressed 
as (ignoring the effects of the antiwindup logic) 

V 8) _ ^P 8 + „ ON 

V 8 ) “ x ]>) * s (3 ‘ 8) 

where K^p and K EI are the proportional and integral gains, 
respectively. If we define the controller state as 

- Rfl “ Kef^d “ x i> (3.9) 

then the controller state and output equations can be expressed 
as 

*5 - k ei^a " x l^ (3.10) 


and 


" x 5 + *EP^“A ” x l^ 


(3.11) 
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The actual output Is then modified by the antiwindup logic 

to produce the final desired ratio. The low pass filter trans- 
fer function is given as 


^jj(s) TgS+l 


(3.12) 

where T E is the filter time constant and a> D is 
fuel engine speed corresponding to the current 
setting. If we define the filter state as 

the minimum 
throttle 


x 8 * “A 


(3.13) 

then from (3.12) 



*8 ’ * ^ + \ “d (u 1> 


(3 . 14) 

where the dependence of o>g on u^ is shown explicity. Using 
(3.13) in (3.10) and (3.11) we have 


*5 * ^EI^ X 8 ‘ *1 ) 


(3.15) 

* *5 + ^EP^ X 8 ' x l> 


(3.16) 


The state and output equations for the engine speed controller 
are thus given by (3.14), (3.15) and (3.16). 

3.5 Ratio Control Loop 

The ratio control loop is shown in Figure 3.6. In designing 
the ratio controller it is important to note that it is not 
necessary for the actual ratio, x^, to equal the desired ratio, 


Desired 

Ratio. 



Ratio Changing Mechanism 
Second Order Dyanmics 


Ratio, Xj 


Figure 3 . 6 Ratio Control Loop 

R D , in steady state. The ratio is being changed so that the 
engine speed equals the engine speed set point; the actual, 
final value of ratio which achieves this is unimportant. Hence 
the ratio controller need not contain an integral term for 
zero steady state error. This controller is therefore chosen 
to be a proportional controller only. Thus, from Figure 3.6, 

U£ ** ~ X 3 ) (3.17) 

where K^p is the proportional gain of the ratio controller. 

Using (3.16) in (3.17) we have 


U£ 1=1 I x 5 ^8 " x i^ ” ^ 3 ^ 


(3.18) 
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The second order dynamics relating x 3 and are given by (2.4) 
and (2.5). 

The value of K^p can be chosen to speed up the second order 
response of the ratio changing mechanism. In fact, this is the 
only reason for using a ratio control loop rather than having 
the engine speed controller generate Ug and directly drive the 
ratio changing mechanism. It is important to note, however, 
that with a proportional ratio controller there is a second 
order system between the output of the engine speed controller 
and x 3 , independent of whether the engine speed controller 
generates a set point for a ratio loop or generates the actuator 
input U 2 directly. 

3.6 Summary of Closed-Loop State Equations 

Since the closed loop-system state equations are spread 
throughout Section 2.0 and this section, it is useful to sum- 
marize them here for easy reference. First, the closed -loop 
system states are defined as 

* engine speed. 

X 2 ■ developed engine torque 
x 3 - CVT ratio. 
x 4 - i 3 

x 5 , Xg ■ states characterizing throttle controller. 

Xg, Xy 31 states characterizing engine speed controller. 

The states x^ through Xg are not easily associated with physical 
variables because both controllers contain numerator dynamics. 
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1 

i 

The state equations are listed below using the equation number 
from previous sections. 

• x 2 " Mr x 3 + ^2 + X 1 x 4^ 

» — — — 

J E + ^ r a *W x 3 

(2.2) 

x 2 - - [x 2 - ♦ 3 (x 1 .u 1 )] /t l 

(2.3) 

x 3 “ x 4 

(2.4) 

x 4 * ^2 x 3 "** ^l x 4 + ^3 U 2 

(2.5) 

x 5 " K EI (x 8 ' x l> 

(3.15) 

x 6 " *VI* v D “ ^^*1 X 3^ 

(3.3) 

1 ^VP 

x 7 * ^<*6 - x 7> + — < V D ' R A R W*1 X 3 ) 

(3.7) 

*8 ’ ^ '~* 8 + 

(3.14) 

where v^ is the driving cycle velocity, WpO^) is the 
minimum fuel engine speed as a function of throttle setting 
(minimum fuel curve), u^ is the throttle input, u 2 is the ratio 
actuator input, is the steady state torque from the engine 

map, <f>^ reflects the effects of road load losses on engine 
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speed and $2 reflects the effects of braking torque and grade 
on engine speed. The rest of the entries in the above equations 
are constants. Reference should be made to the appropriate 
prior section (determined by the equation number) for more 
details. The control inputs and U 2 are generated from the 
states by 


and 
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x 7 

> 100 

U^ - 4 

1 *7 ' 
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£ < 100 


/ — 
w 

x 7 

< 


u 2 * Kpp 1*5 + ^(Xg-x^) “ *3] 


(3.18) 


Here, represents idle throttle (see Figure 3.4). 

Having described the control approach and the details of 
the control system, we conclude this section with a brief 
discussion of how the control system might be implemented in an 
actual vehicle. 


3.7 Control System Implementation 

The control system is envisioned as being implemented with 
an on-board microcomputer -based system. The control algorithms 
discussed in the previous subsections are easily programmed on 
such a system, and the measurements required for control are 
all easily generated from standard sensors. 

A block diagram of the control system showing the operator, 
control computer and vehicle is given in Figure 3.7. To 
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implement the control algorithms, the control computer requires 
measurements of vehicle velocity, engine speed and ratio. If 
the ratio is not measurable directly from the CVT, it can be 
calculated from engine speed and vehicle velocity (see Equation 
(2.6)). The control algorithms Implemented by the computer are 
discrete time versions of equations (3.3), (3.7), (3.14), (3.15) 
and (3.18) (See Section 4.1 for the sampling time) which are 
given at the end of Section 3.6. These algorithms are easily 
implemented and do not require the use of component maps and 
interpolation. 


Operator 


Vehicle Desired 
Velocity , 


Vehicle 

Velocity 


Control 

Computer 


Throttle Setting 


Ratio Actuator Input 


Control Braking Signal J 


Ratio 


L Engine Speed. 


^ Vehicle Velocity. 


Operator Brake Pedal Position 


Vehicle 


Figure 3 . 7 Computer Implemented Control System 
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It is assumed that the operator manipulates some sort of 
device (e.g. a pedal) to indicate desired velocity. Based on 
this demand, the control computer generates a throttle setting 
and a signal to change the ratio so that the desired velocity 
is achieved and the engine is running most efficiently. The 
computer also displays vehicle velocity to the operator. The 
brake pedal is assumed to be under the control of the operator. 
However, it is conceivable that the control computer could also 
generate braking actions to make the vehicle achieve a desired 
velocity. In fact, this approach was adopted in this study 
(see Figure 3.5). Having described the control system and the 
vehicle dynamics in this and the previous section, respectively, 
we now turn to a description of how the overall system was 
simulated in order to tune the controllers and study the dynamic 
behavior of the overall closed-loop system. 


4.0 SYSTEM SIMULATION 


The performance of the closed-loop system was evaluated 
using a digital computer simulation of the vehicle dynamics 
and the control algorithms. The vehicle was made to follow 
a specific velocity vs. time profile or driving cycle 
(SAE J227a, schedule D (modified)) as shown in Figure 4.1. 

The driving cycle velocity provided the command input to the 
throttle controller. In effect, the simulation solved the 
eight state equations describing the vehicle and controller 
dynamics for given initial conditions and the given driving 
cycle. The equations actually solved are given in Section 
3.6; equations (2.2) through (2.5) describe the vehicle dy- 
namics, while equations (3.3), (3.7), (3.14), (3.15) and 
(3.18) describe the controller dynamics and outputs. The 
simulation results are trajectories of vehicle and controller 
states and outputs (as the vehicle traverses the driving cycle) 
as well as vehicle energy consumption. 

In the actual simulation, two different time scales were 
used for integrating the vehicle and controller state equations. 
The controller state equations were approximated with discrete 
time equivalents with a basic sampling period or time step 
size of 0.1* seconds. Hence the control inputs to the vehicle 
dynamics were updated every 0.1 seconds and held constant be- 
tween updates. This was felt to be quite acceptable because 
it simulated what an on-board computer would actually do; the 
computer would generate piecewise constant controls updated 
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only at sampling instances. On the other hand, the vehicle 
state equations were Integrated using a variable step size 
Runge-Kutta integration scheme which produced an average step 
size which was orders of magnitude smaller than 0.1 second. 

This, of course, makes sense since the vehicle is a continuous 
system and not piecewise constant as are the controller outputs. 

The simulation program was organized into several Fortran 
subroutines whose primary purposes are listed in Table 4.1. 
Subroutines PHI3, PHI4 and PHI6 use steady-state engine 
characteristics, in the form of table or "maps", and inter- 
polate as necessary to yield the desired results. A detailed 
listing of the simulation program is given in Appendix C. 
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Subroutine 

MAIM 

Purpose 

Inputs data, coordinates simulation of system for 
driving cycle, computes control Inputs, outputs 
results. 

NIM 

Numerically integrates state equations using 4th 
order Runge-Kutta method. 

RHS 

Computes right hand side of state equations for MIM. 

PHI1 

Computes drag and rolling resistance. 

PHI2 

Computes braking torque and effect of grade angle on 
vehicle . 

PHI3 

Computes steady state engine toroue for given throttle 
and engine speed. 

PHI4 

Computes most fuel-efficient steady state engine 
speed for given throttle position.' 

PHI5 

Limits the CVT ratio within pre-defined bounds. 

PHI 6 

Computes steady state fuel rate for given engine 
speed and throttle. 

VSP 

Calculates driving cycle velocity for any time. 


Table 4 . 1 Simulation Program Subroutines 








5.0 SIMULATION RESULTS 


The overall objective of the simulation was to study the 
feasibility of the control approach described in the preceeding 
sections. In particular, the simulation revealed the degree to 
which the controllers described in Section 3.0 can control the 
propulsion system, the ease or difficulty of tuning the con- 
trollers, and the nature of the resulting dynamic behavior of 
the vehicle. We consider these results in the subsections 
below. 

5.1 Controller Tuning 

The controllers were timed so that the vehicle satisfactorily 
followed the specific driving cycle shown in Figure 4.1. The 
driving cycle consisted of an acceleration phase followed by 
a cruise phase and, finally, a braking phase. Two different 
(but constant) decelerations were assumed for the braking phase. 
The driving cycle served as a velocity command input to the 
propulsion control system. 

Three controllers required tuning: the vehicle velocity 
or throttle controller, the engine speed controller and the ratio 
controller. In addition, the time constants of the two smoothing 
filters (one after the minimum fuel curve and one after the 
velocity PI controller) had to be selected. Specifically, it 
was necessary to select values for the proportional and integral 
gains, Kyp and Kyi. respectively, of the throttle controller, 
the proportional and integral gains, Kgp and Kgp respectively, 
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o£ the engine speed controller, the proportional gain, K^p, of 
the ratio controller, and the two filter time constants, T g 
and 

Since the ratio control loop (see Figure 3.6) consists 
of the proportional control of a known, second order system, 
the gain, Kgp, was determined analytically; the particular value 
was chosen so that the ratio loop responded as a critically 
damped second order system to a step change in the ratio set 
point. Furthermore, it was found from repeated runs of the 
simulation that a time constant of 1.0 seconds for both filters 
provided adequate smoothing. 

Generally speaking, an iterative process was used to select 
the gains for the throttle and engine speed PI controllers. 

The throttle controller was first tuned to obtain as close a 
match as possible between driving cycle velocity and vehicle 
actual velocity ("close" was measured by a combination of 
velocity mean square error and visual examination of the 
velocity profile) . Then the engine speed controller was ad- 
justed to obtain as close a match as possible between actual 
and desired engine speed ("close" measured by mean square error) . 
Each time any of the four gains was changed, a resimulation of 
the complete driving cycle was required to evaluate the effects 
of the gain change. The process was repeated until no signi- 
ficant overall improvement in either the velocity error or 
engine speed error was obtained; although time consuming, the 
procedure did converge to a set of gain values which gave 
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reason ably good dynamic response of the vehicle. The specific 
values for the controller gains are given in Appendix B. An 
example of responses which are representative of the best re* 
sponses are given in Figures 5.1 through 5.4. These are dis- 
cussed in detail in the next subsection. 

5.2 Closed Loop Dynamic Response of the Vehicle 

The dynamic responses of interest for the closed loop 
system are those of vehicle velocity, CVT ratio, engine speed 
and throttle setting. 

Figures 5.1 through 5.4 show examples of the best responses 
obtained. In interpreting these curves, it should be remembered 
that for a given vehicle velocity, an increase in ratio is 
required to produce a decrease in engine speed. The basic re- 
sponse of the vehicle is summarized as follows: Initally the 

vehicle is at rest with an idle throttle, an idle engine speed 
and a zero ratio. As the driving cycle starts, the velocity 
error causes the throttle to increase. This in turn causes 
both the engine speed and its set point (via the minimum fuel 
curve) to increase. The engine speed is actually above the 
set point, so the ratio increases to bring this speed down. 

At about 457o throttle there is a rapid increase in engine speed 
set point (due to the nonlinear minimum fuel curve) which causes 
the ratio to drop to bring up the engine speed. This type of 
dynam *• behavior continues (with the ratio slowly increasing 
again as the engine speed overshoots the set point) until the 
cruise part of the driving cycle is reached. At this point the 
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velocity error rapidly decreases causing the throttle to drop 
off sharply. This, in turn, causes a rapid drop in desired 
engine speed via the minimum fuel curve to bring the engine 
speed down the ratio therefore increases to about 2.3. When 
the cruise period is complete, it is necessary to apply various 
amounts of braking torque to make the vehicle follow the driving 
cycle from cruise down to a stopped condition. During this 
time, the throttle is constant at idle position and the engine 
speed makes small excursions below the idle speed desired. 

Finally, the vehicle comes to a stop as a result of sufficient 
braking torque and the ratio approaching zero. 

The responses demonstrate that the control system is 
capable of making the vehicle follow the driving cycle velocity 
profile while at the same time keeping the engine at the minimum 
fuel consumption engine speed; Figure 5.2 shows that there is 
very little error between desired and actual engine speed. 

Although the vehicleb actual velocity is quite close to the 
driving cycle velocity, there is some error during the acceleration 
phase and at the start of the cruise phase. To a large extent, 
this is due to the classical tradeoff in control system design 
between tracking error and transient response. If the velocity 
controller gain is increased so that the vehicle tracks the 
velocity ramp in the acceleration phase more closely, the 
transient response will be made more oscillatory and there will 
be a larger overshoot when the cruise phase is reached. In 
addition, as discussed later, increasing this gain to reduce 
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the cracking error can also introduce instabilities when the 
vehicle first begins to accelerate. 

In tuning the controllers to produce the above responses 
a number of observations were made concerning the sensitivity 
of the responses to controller gain values, and instabilities 
and unexpected dynamic behavior of the closed loop system. These 
observations are given below. 

With regard to controller tuning, it was found that the 
responses of the vehicle variables were rather sensitive to 
choices for the controller gain values. This was due in large 
part to the nonlinearities of the vehicle and, particularly, 
the nonlinear minimum fuel curve. Examination of Figure 3.1 
shows that the minimum fuel engine speed is a highly nonlinear 
function of throttle setting; examination of Figure 3.3 re- 
veals that this nonlinearity acts as a nonlinear gain in the 
loop which is controlling engine speed by manipulating the ratio. 
The presence of a nonlinear gain makes it particularly dif- 
ficult to come up with one set of controller gains which will 
give good transient response over a wide range of vehicle 
operation. If the controller gains are selected to give good 
transient response for throttle settings below 457. (the low 
gain region on the curve) , then during acceleration when the 
throttle moves into the region above 45% (high gain region) 
the loop gain goes up markedly and the response will tend to 
be oscillatory. In fact, complete instability of all four 
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variables during Che acceleration phase of Che drive cycle was 
often observed in Che process of tuning Che controllers. The 
final method used to deal with this nonlinear gain was a worst 
case approach: choose controller gains so that good performance 
was achieved in the high gain region of the minimum fuel curve; 
the closed-loop system would then be a little sluggish in the 
low gain region of the curve, but it would not produce oscil- 
lations in ratio, throttle and vehicle velocity. 

Two other approaches to deal with this nonlinear gain which 
were considered but ultimately discarded are outlined below. 
First, with reference to Figure 3.3, a nonlinear gain was 
introduced at the output of the throttle controller; the output 
of this nonlinear gain was the throttle setting, u^. The new 
nonlinearity was chosen to exactly compensate for the minimum 
fuel curve nonlinearity; in effect the gain in the engine 
speed control loop was made to be linear and the nonlinearity 
of the minimum fuel curve was shifted to the vehicle velocity 
control loop. It was felt that the performance of this latter 
loop might be less sensitive to the presence of a nonlinear 
gain. However, this did not turn out to be the case and the 
approach was abandoned. The second approach was similar to 
the first: the gains of the velocity PI controller were made 
to depend on the throttle position. In effect, the gains were 
decreased if the system was operating on the high gain portion 
of the minimum fuel curve. This approach exhibited instabilities 
as the system was passing from one gain region to the next, and 
so was also abandoned. 
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As mentioned above, an approach which gives satisfactory 
results is to tune the controller for the worst case where the 
system is operating on the steep part of the minimum fuel curve. 
Alternatively, consideration should be given to using an 
approximate, linear minimum fuel curve. It is not practical 
to control the engine speed to exactly the minimum fuel con- 
sumption engine speed for each throttle setting; the throttle 
is continually changing and there is always lag in the engine 
speed control loop. It would appear that the use of an approxi- 
mate, linear minimum fuel curve will lead to both good fuel 
consumption characteristics and good dynamic response of the 
vehicle. 

We now discuss the actual dynamic responses observed for 
the vehicle velocity, engine speed, ratio and throttle setting; 
instabilities and unusual dynamic responses observed during the 
simulation runs are discussed. We begin this discussion by 
first noting that the control loop on vehicle velocity and the 
one on engine speed are highly interacting. Throttle is used 
to control velocity, while ratio is used to control engine 
speed. This can be viewed as a two input/two output system 
as shown in Figure 5.5. The strong interaction between the 
loops comes about because a change in throttle (with ratio 
constant) will cause a change in both vehicle velocity and 
engine speed; similarly, a change in ratio (with throttle 
constant) will produce a change in both velocity and engine 
speed. Furthermore, the throttle setting (control input for 
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the top loop Figure 5.5) determines the set point for the bottom 
loop. Hence a change In throttle forces a change In ratio. This 
strong and unusual type of Interaction (the set point of one 
loop determined from the control input to another loop) makes 
this system very difficult to control. 



Figure 5.5 Two Input /Output Model of Control System 

A typical instability in a! I four variables observed 
during the simulation runs was at start-up when the vehicle 
first begins to traverse the uriving cycle (see Figure 5.5). 
The sequence of events is as follows. The desired velocity 
increases above zero, causing the throttle setting to increase 
above idle throttle. The vehicle will not move, however, 
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until the ratio comes off zero. This will begin to occur in 
this instance because as the throttle setting Increases, the 
desired engine speed also increases; this produces an engine 
speed error which causes the ratio to increase from zero. 

The instability begins to show up if either or both of the pro- 
portional gains of the controllers are too large. In this 
case, as the desired velocity initially increases there is a 
large throttle increase for the essentially unloaded engine 
(ratio is still close to zero). This causes the engine speed 
to increase rapidly and become much larger than the desired 
minimum fuel engine speed set point corresponding to the throt- 
tle setting. This large engine speed error, in turn, causes 
a large increase in the ratio in an attempt to bring the engine 
speed down. The increased ratio and large throttle setting 
cause the vehicle to accelerate rapidly, resulting in a vehicle 
velocity which is much greater than the desired velocity cor- 
responding to the driving cycle. Also, the engine speed has 
now dropped below the set point due to the load placed on the 
engine. At this point the sequence of events is reversed: to 
counteract the large velocity error the throttle is set back 
to almost idle; the desired engine speed corresponding to this 
lower throttle is still above the actual engine speed, hence 
the ratio drops to almost zero. This cause3 the vehicle to 
come to a standstill, causing the throttle in turn to once 
again increase by a large amount. The cycle is then repeated. 
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The gains which cause the above Instability are not un- 
reasonable. For example, the Instability was initially ob- 
served while attempting to tune the controllers by Increasing 
the proportional gains so that the vehicle would more closely 
follow the ramp of desired velocity during the acceleration 
phase of the driving cycle. The start-up instability described 
above was the determining factor in how large the proportional 
gains could be made; keeping the gains low to avoid the in- 
stability produced a noticeable velocity error during the ac- 
celeration phase of the driving cycle (see Figure 5.1). This 
error could not be reduced by increasing the Integral gain 
of the velocity controller because such an Increase would pro- 
duce too much velocity overshoot when the cruise phase of the 
driving cycle was reached (again, see Figure 5.1). The integral 
gain finally selected represented a tradeoff between velocity 
error during the acceleration phase and velocity overshoot 
when the cruise phase is reached. 

A second, and quite dramatic, instability occurred during 
either the acceleration or cruise phase of the driving cycle. 

As with the start-up instability described above, this in- 
stability is a consequence of the pronounced interactions in 
the system, i.e. throttle changes and ratio changes each have 
a strong effect on both vehicle velocity and engine speed. If 
the controllers are not tuned properly, this interaction can 
cause the vehicle to actually speed up as that throttle is 
decreased during either the acceleration or cruise phase of the 
driving cycle. Responses of the system variables showing this 
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in8Cablllty are given in Figures 5.6 through 5.8. It must be 
remembered in examining these responses that they represent 
the case of improperly tuned controllers; they are Included 
only because of the interacting instability they reveal. 

Between about 15 seconds and 30 seconds the throttle is 
decreasing dramatically, yet the vehicle velocity continues to 
increase. Similarly, from 40 seconds to about 50 seconds the 
throttle increases while the vehicle velocity decreases. This 
phenomenon is due to the strong effect that both ratio and 
throttle have on vehicle velocity; the behavior from 15 to 30 
seconds is explained as follows (the behavior from 40 to 50 
seconds is explained by just the opposite reasoning). As the 
throttle is decreased to slow down the vehicle, the desired 
engine speed also decreases; this causes the ratio to increase 
in an attempt to bring the engine speed down. However, in- 
creasing the ratio also speeds up the vehicle, resulting in 
a further decrease in the throttle. If the ratio change has 
a greater effect on the vehicle velocity than the throttle 
change (which can occur in certain operating regions) then the 
above sequence of events will cause the vehicle to speed up as 
the throttle is decreased. 

This type of behavior would, of course, be unacceptable 
to a human driver; less throttle means the vehicle must, with- 
in a short time, slow down, not speed up. In effect, what is 
occurring above is that the vehicle is being driven by the ratio, 
i.e. the ratio rather than the throttle is having the dominant 



48 



A 

<n 

a 

z 

8 

Ul 

(/) 


Ul 

x 

M 

f- 


All 0013 A 


Fleur e 5.6 Vehicle Velocity for Improperly 
Tuned Con t r oll e r s^ 


THROTTLE CXWQT) RATIO 


2.0 



TIME <SECONCS> 


Figure 5 . 7 Ratio for Improperly Tuned Controllers 





Figure 5.8 Throttle for Improperly Tuned Controllers 


100. L 100 


-50- 


effect on vehicle velocity and it is being manipulated in a way 
to maintain the vehicle velocity at the driving cycle set point 
velocity. The problem is avoided by proper tuning of both 
controllers. 

5. 3 Conclusions 

The experience gained from numerous simulations and from 
working with the controllers has led to a number of conclusions 
regarding the feasibility of the control philosophy and approach 
described in the preceeding pages of this report. To reiterate, 
the control philosophy is to minimize fuel consumption by 
manipulating throttle to achieve vehicle desired velocity and 
by manipulating ratio so that, for each throttle setting, the 
engine is operated at its minimum fuel consumption point. The 
simulation results demonstrate that it is feasible to control 
a vehicle in such a manner, and it is possible to do it with 
relatively simple controllers (PI controllers with anti-windup 
logic) which use easily measured system variables (CVT ratio, 
engine speed and vehicle velocity). Furthermore, there would 
be no difficulty in implementing the control system with an 
on-board microcomputer. 

The simulation results also demonstrate that the vehicle 
nonlinearities and the minimum fuel curve nonlinearity can 
cause instabilities in vehicle operation both at start up and 
during the acceleration and cruise phases of the driving cycle. 
These instabilities can be avoided by proper tuning of the 
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controllers. To simplify the job of tuning the controllers, and 
to minimize the possibility of producing an instability, con- 
sideration should be given to replacing the nonlinear minimum 
fuel curve with a straight line approximation, i.e. minimum 
fuel engine speed should be approximated by a linear function 
of throttle setting. 


6.0 CONCLUSIONS AND FUTURE WORK 


This project has demonstrated, for the first time, that it 
is possible to achieve satisfactory, stable control of all 
significant dynamic variables of a heat engine-CVT vehicle pro- 
pulsion system by designing linear control loops for control 
of engine speed, throttle position and CVT ratio. The system 
simulation has illustrated the difficulty of controlling this 
nonlinear system which exhibits strong interaction between the 
input variables (CVT ratio and throttle) and output variables 
(engine speed and vehicle speed) . 

The feasibility of controlling the propulsion system so that 
the vehicle followed the modified SAE driving cycle was demon- 
strated by the simulation. Satisfactory dynamic responses of 
the variables were accompanied by a low average deviation of 
the engine speed from its desired, low fuel consumption value. 

The control algorithms developed were in a simple, linear 
form which could easily be implemented on-board a vehicle using 
a microcomputer. 

Future work could be concerned with adding a flywheel for 
energy storage to the system as investigated to date, and then 
to investigate the resultant control problems. Before such 
an investigation could be started, it would be necessary to define 
decision rules or strategies for using two sources of on-board 
energy, the engine and the flywheel. Thus, a prime candidate 
for near term future work is an investigation of power flow 
strategies for a vehicle with two (or more) on-board power 
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sources. This should be followed by investigations into imple- 
menting these strategies using control systems. 
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APPENDIX A 


VEHICLE MODEL 


Section 2.0 of the report presents an overview of the 
methods used to model the vehicle and the resulting state 
equa; Ions which describe the vehicle dynamics. This Appendix 
is devoted to a detailed presentation of this material. In 
developing the vehicle model, the following variables will be 
used (Appendix B contains a complete list of all variables 
and parameters used in the vehicle model) : 

D - vehicle drag force. 

J eq * equivalent load inertia as seen Dy the CVT. 

R » vehicle rolling resistance force. 

R t - CVT ratio. 

T^ * torque required at rear axle. 

T fi » braking torque. 

T E * actual torque developed by the engine. 

T l « equivalent load torque as seen by the CVT. 

T m - steady state engine torque. 

T^ » load torque seen by the engine. 

u^ * throttle setting. 

U£ * ratio actuator input. 

v * vehicle velocity 

v w - wind velocity 

x^ « vehicle first state (*= uij.) . 

X 2 * vehicle second state (■ T E ). 

Xj - vehicle third state (■ R T ) . 

x^ - vehicle fourth state (■ R^) . 
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6 « grade angle, 
uig ■ engine speed. 

Uq * drive shaft speed. 

The drive train of the vehicle is shown in Figure A1 and 
consists of a heat engine (HE) , a continuously variable trans- 
mission (CVT) , and a differential to transmit power from the 
drive shaft to the rear axle and wheels . Before deriving the 
equations which govern the overall dynamics of the vehicle, 
we first present the methods used to model each of the 
individual components. 



Power to 
Rear 
Wheels 


Figure A1 Drive Train Configurations 

Heat Engine : The heat engine model is shown in Figure A2 

and consists of a steady state engine map (which determines a 
steady state engine torque, T m , for a given throttle setting, 
u^, and engine speed, u>g), a first order lag which models the 
throttle linkage and engine combustion dynamics (see Section 2.1 
under heat engine model), and a rotating inertia. 
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Figure A2 Engine Model 


Continuously Variable Transmission : The CVT is modeled as 

shown in Figure A3 and consists of an inertia J T , an efficiency 
Kf and a ratio, R^, which is allowed to vary continuously from 
zero to infinity. The inertia is defined to be the equivalent 
CVT inertia as seen on the drive shaft side of the CVT. It 
is also assumed that there are second order dynamic effects 
associated with changing the ratio, i.e. if there is a step 
change in the variable, U2 , which controls the ratio, then the 
actual ratio will respond with a second order response. 



Figure A3 CVT Model 
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Differential : The differential is modeled in exactly the 

same way as the CVT, except that the ratio is fixed; hence 
there is a differential inertia, J A (defined to be the inertia 
of the differential as seen on the axle side of the differential) , 
an efficiency, K A , and a ratio, R A (defined to be the ratio 
of axle speed to drive shaft speed) . 

Vehicle Body : The vehicle body is assumed to consist of 

a mass to be accelerated (up or down a grade, as necessary) 
which is subject to aerodynamic drag and rolling resistance 
forces and braking torque. 

In deriving the equations which describe the dynamic be- 
havior of the drive train and vehicle body, we combine all of 
the inertias downstream of the CVT with the CVT inertia to form 
an equivalent load inertia; we also develop an expression for 
an equivalent CVT load torque which includes the combined 
effects of the aerodynamic drag and rolling resistance forces, 
the braking torque and the force necessary to accelerate the 
vehicle mass. The overall model is shown in Figure A4. In 
addition, as mentioned earler, the CVT ratio, Rj, has a second 
order dynamic response to a change in the ratio actuator input, 

U2> as shown in Figure A3. Finally, the engine model includes 
a ‘first order lag between the engine map and the developed 
engine torque, Tg, to simulate the dynamics of the throttle 
linkage and engine combustion. This is shown in Figure A2. 



®T 


Figure A4 Overall Model of Drive Train 


From Figure A4 we can write 


J E W E " T S " T 1 


J EQ U D * ” T l 

and 

W D " 

where is the engine inertia. Differentiating (A3) and 
noting that the ratio is time varying, we get 

“D * ®T E + ^T W E 

Using (A4) in (A2) and solving for yields 


T 1 “ *4" J EQ^ R T U, E + ^T^E^ + 


Then using (A5) in (Al) we can write 


^E^E ” T E ’ ®T J EQ^ 8 T“E + R T u, E^ * ®t t l 


or 
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(J £ + r| J £ q) <d e - -RjRp ^eqWe +T E “ 


(A6) 


It is now necessary to develop expressions for J E q and T E 
to substitute into (A6). First consider J e q. This inertia 
consists of the sum of the CVT inertia, J T , plus the differen- 
tial inertia reflected through the differential ratio and 
taking into account the CVT efficiency (see Figure A3; note 
that J T is upstream of and that the equivalent inertia 
J E q is being computed at the position of J«p) » end the com- 
bined axle and wheel inertias, Jy, reflected through the 
differential ratio and taking into account the efficiencies 
of both the differential and the CVT. Following standard pro- 
cedures for reflecting inertias, we can write 

J EQ * *T + < R i /K T> J A + «i/KT>J A + ^®A^ K A*T 3 

Next, we derive an expression for the equivalent load torque, 

T l , as seen by the CVT. The forces acting on the vehicle 
are given as 

2 

Drag Force - D - %(p/g)C D A(v + v y ) sgn(v+Vy) (A8) 

Rolling Resistance Force ■ R - 

yW(l+1.4x 10“ 3 v + 1.2 x 10~ 5 v 2 ) (A9) 

Acceleration Force * (W/g)v (A10) 

Grade Force - Wsin$ (All) 

Multiplying the sum of these forces by the wheel radius, and 
adding the braking torque to the result, we obtain the torque. 
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T a> required at the axle necessary to provide the vehicle with 
acceleration v: 

T A - Rw I D + R + Wsinfi + <W/g)v] + T b (A12) 

Reflecting this torque through the differential efficiency 
and ratio, and through the CVT efficiency, we obtain 

•r L - T a (R a /K a Kt> (A13) 

Finally, we note that 

v-RARyR^ (A14) 

and 

v - WVe' 1 ' Ve ) <A15) 

We are now in a position to derive the first (of four) 
state equations which govern the vehicle dynamics. Substi- 
tuting (A14) and (A15) into (A12), and that result into (A13), 
we can express as a function of o>£ and <I>£ rather than v 
and v. Then substituting that result for along with (A7) 
into (A6) , and using the notation x^ - u> E , x 2 - T E , x 3 - Rj 
and x 4 - Rj, we get 

"[x 2 - MipXj + 4*2 ^ ^a X 1 X 4^^E ** ^T^A ^W*3 ^ (A16) 

where 

♦ l • ®a (D+R) /M j K a Itp (A17) 


4*2 * ^ K^W sin$)/Mj 


(A18) 
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Mj ■ (Jip/R^Ry) + (R^ J^/K^ (A19) 

My - (W/g) + (Jy/Ry 2 ) <A20) 

The above state equation describes the response of engine speed, 
x 1 to changes in developed engine torque, x 2 , CVT ratio, x 3 
and x^, grade angle, 0 , braking torque, Tg, and wind velocity, 
Vy. Given engine speed, vehicle speed can be determined from 
(A14) . 

The second state equation describes the response of 
developed engine torque to changes in engine speed and throttle 
setting (Characterizes throttle linkage and engine combustion 
dynamics, as well as engine steady-state torque-speed 
characteristics). Referring to Figure A5 we can write 

*2 - - I x 2 - ♦3< x l' u i)l / t l (A21 > 

where u^ is throttle setting and $ 3 (xpU^) is the torque 
from the steady state engine map. • 

The third and fourth state equations describe the second 
order dynamic response of the ratio, x 3 » R«p, to changes in 
the ratio actuator input, u 2 . In particular, 

X 3 » x^ (A22) 

x^ ■ x^ 4" C 2 X 3 C 3 u 2 (A23) 

where C 2 and C 3 are constants which determine the actuator 
gain and second order dynamics. 

Equations (A16), (A21), (A22) and (A23) are the vehicle 
state equations used in the study. 


APPENDIX B: PARAMETER VALUES 


Parameter 

Description 

Value 

A 

frontal area of vehicle 

2.00m 2 

C D 

vehicle drag coefficient 

0.45 

C 1 

constant describing actuator dynamics 

-12.0 s’ 1 

C 2 

constant describing actuator dynamics 

-12.0 (s 2 )' 1 

C 3 

ratio actuator gain constant 

20.0 (v-s 2 )' 

g 

gravity constant 

9. 807 m/s 2 

J A 

inertia of differential (as seen on axle 
side of differential) 

0.02 m 2 -kg 

J E 

engine inertia 

0.113 m 2 -kg 

J T 

CVT (drive shaft side of CVT) 

9 

0.60m -kg 

J W 

combined inertia of all four wheels 

7. 052 m 2 -kg 

k a 

efficiency of differential 

0.96 

k ei 

integral gain, engine speed controller 

0.09 rad* 1 

k ep 

proportional gain, engine speed controller 

0.018 s/rad 

k rp 

ratio proportional controller gain 

2.6 v 

Kt 

efficiency of transmission 

0.9 

K VI 

integral gain, velocity controller 

1.8 m* 1 

K VP 

proportional gain, velocity controller 

20.4 s/m 

r a 

differential ratio (ratio of axle speed to 
drive shaft speed) 

0.362 

*w 

vehicle wheel radius 

0.295 ra 

w 

vehicle total weight 

15,124 n 

0 

grade angle 

0.0 

y 

coefficient of rolling friction 

0.0154 n/kg 

p 

air weight density 

12.02 n/m 3 

t e 

engine speed filter time constant 

1.0 s 

t t 

throttle filter time constant 

1.0 s 

t l 

Time constant: linkage dynamics 

0.5 s 
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0001 

0002 

0003 

0004 

0005 

0006 

0007 

0008 

0009 

0010 
0011 
0012 

0013 

0014 

0015 

0016 

0017 

0018 
001 ? 
0020 
0021 
0022 

0023 

0024 

0025 

0026 

0027 

0028 

0029 

0030 
C031 

0032 

0033 


FTN4,L 

C 

C 

C 

C 

C 

C 

C 

C 

C 

C 

C 

C 

C 

C 

C 

C 

C 

C 

C 

C 

c 

c 

c 

c 

c 


PROGRAM HCVT (3,100) 

*** *************************************************************i* 
****************************************************************** 
******* HEAT ENGINE/CVT SYSTEM SIMULATION ********************** 
****************************************************************** 
****************************************************************** 


3^ ^ )jl )|( )|( )(t )|t )|t X X )|t * )jt * )|t ]|t * )|t )|t ]|t )|t )|( ]|t % )|( )|( )|t )jt )(l )|t )|t )|t l|t )|( )|( )|t )|t)|( 3|t )|l )|( ]|t )|t )|t ^ ^ ^ 

*************** SYSTEM VARIABLES ***************************** 

3^ IX 3^ )|^ 3|t )|( )|t X 3^ 3|t X ^ 3|t 3|t 3|t ]|t )|t 3|l )|t )|t )|t )|t 3|( )|t 3|( 3|t l|t )|( )|t 3(t 3|( 3jt )|t 3(( )j( 3|t 3|t )|t 3|t )l( 3^ )(t 3jt )|t 3jl 3|( 


A-VEH. FRONTAL AREA, (M**2) . 
BP-XMISSION DAMPING FACTOR. 
CD-VEH . DRAG COEFF . 
DCP-DRIVING CYCLE PERIOD, <S). 
ENGMAP ( I , J ) -ENG . TORQUE WHEN 
ENG. SPEED IS ENGSP(I) AND 
PEDAL IS PEDPCT < J) , (N-M) . 
EW=ENG . SPEED ERROR, (R/S). 
FUEL-FUEL CONSUMP . RATE FOR 
GIVEN ENG. SPEED AND 
PEDAL, (LBS/HR). 

G-GRAVITY CONST . , (M/S**2) . 
INPR IN-NO . OF SIMUL. STEPS 

BETWEEN RESULTS PRINTS 
JPR-COUNTER USED TO DETERMINE 


BETA(I)«ROAD GRADE OVER DRIVING 
CYCLE, (DEGREES) . 

D-VEH . DRAG FORCE, (N). 

DELT-SIMUL . TIME STEP SIZE,(S>. 
ENGSP< I IMPOSSIBLE ENGINE SPEEDS 
ON ENG. MAP, (R/S) . 
ER-XMISSION RATIO ERROR. 
FUAV-AVER . FUEL CONSUMPTION 
RATE, (LBS/HR) . 

FUR ATE ( I, J) -ARRAY OF VALUES OF 
FUEL CONSUMP . RATES FOR GIVEN 
ENG. SPEED AND PEDAL, (LBS/HR) 
JA-AXLE INERTIA, (KG-M**2) . 
JE-ENG. INERTIA, (KG-M**2) . 
JT-XMISSION INERTIA, (KG-M**2) . 


C IF PRINT /OUT SHOULD OCCUR 

C KA-EFF . OF REAR AXLE DIFF'TL. 

C KCEI ,KCEP»INTEGRAL AND PROP 

C GAINS, ENG. SPD . CONTROLLER 

C KP-SPR CONST . OF XMISSION 

C RATIO MOVABLE PULLEY. 


JWF ,JWR -FRONT AND RFAR AXLE 
INERTIAS, (KG-M**2) . 
KCR-RATIO CONTROLLER GAIN. 
KG-XM1SSION RATIO ACTUATOR GAIN. 
KPDI ,KPDP=INT . AND PROP. GAINS, 
PEDAL CONTROLLER. 


0034 C KR-XMISSIQN PULLEY ; RATIO/DIS- 

0035 C PLACEMENT GAIN. 

0036 C LL-L+i 

0037 C MP-MASS OF XMISSION PULLEY. 

0038 C NT-COMPOSITE EXPRESSION USED 

0039 C IN VDOT EQN . , (KG-M) . 

0040 C MWF , MUR-COMBINED MASS OF 

0041 C FRONT AND REAR WHEELS, (KG) 

0042 NL-N+1 

0043 C NMi-N-1 

0044 C NPRMAX-NO . OF OUTPUT LINES 

0045 C PRINTED PER PAGE . 

0 046 C OMAGAE-ENG. SPEED , (RAD/SEC ) . 

0047 C OMPR-VALUE OF ENG. SPD. SET 

0048 C PT. USED FOR PRINTING. 

0049 C PEDL-VALUE OF PDL USED IN RHS 

0050 C PEDPOS(l) -VALUE OF PDl . CORR 

0051 C TO I, USED IN MIN FUEL CURV 

0052 C PHI 1-FCN WHICH COMPUTES 

0053 C EFFECTS OF DRAG AND 

0054 C ROLLING RESISTANCE. 

0055 C PHI3-C0MPUTES ENG TORQUE FOR 


KT-XMISSION EFF. 

L-CURRENT PT . IN DRIVING CYCLE. 
MET-METRIC PRINT FLAG, 1-PRINT 
METRIC, 0-PRINT ENGLISH. 
MU-COEFF. OF ROLLING FRIC.,N/KG. 
MV-EQUIV. VEH. MASS, (KG). 

N-NO. OF STEPS IN DRIVING CYCLE. 
NIN-NAME OF SUBR WHICH 

INTEGRATES STATE EQNS . 
NPR-COUNTER TO DETERMINE IF OUT- 
PUT PAGE HEADER IS PRINTED. 
NV-NO. OF VAR'S INTERG'ED BY NIN 
OMEGSP-ENG. SPD. SET PT.,(R/S>. 
OPTSP ( I >=BEST ENG. SPD. SET PT 
WHEN PDL. HAS VALUE PEDPCT(I) 
PEDPCT ( I )-PDL. VALUES CORRES. TO 
I, USED IN ENGINE MAP. 
PEDPRP-CONTR IB . TO PDL FROM PROP 
PART OF PDL PI CONTROLLER 
PH12-FCN WHICH COMPUTES EFFECTS 
OF BRK . TORQUE AND GRADE. 
PHI 4-COMPUTES ENG SPD SET PT.FOR 



PAGE 0002 HCVT 10 = 14 AH THU., 2t HAY 


1981 


65 
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0056 C 

0057 C 

0058 C 

0059 C 

0060 C 

0061 C 

0062 C 

0063 C 

0064 C 

0065 C 

0066 C 

0067 C 

0068 C 

0069 C 

0070 C 

0071 C 

0072 C 

0073 C 

0074 C 

0075 C 

0076 C 

0077 C 

0078 C 

0079 C 

0080 C 

0081 C 
0 082 C 
0003 C 

0084 C 

0085 C 
0 086 C 
0087 C 
0 088 C 
0089 C 
0 090 C 
0091 C 
0 092 C 

0093 C 

0094 C 

0095 C 

0096 C 

0097 C 

0098 C 
0 099 C 

0100 C 

0101 C 

0102 C 

0103 C 

0104 C 

0105 C 

0106 C 

0107 C 

0108 C 

0109 C 

0110 


GIVEN ENG SPD AND PEDAL. 
PH15=LIH1TS RATIO. 
PHI6“C0HPUTES FUEL CONSUHP . 
R«ROLLING RESISTANCE, (N) . 
RHO»AIR WT. DENSITY, (KG/H#*3) 
RL=REAL VALUE OF L. 
RLIH-LIHITED VALUE OF RATIO. 
RSP-RATIO SET PT . 

RSPHIN-HIN ALLOW VAL. OF RSP . 
RTHAT*UNLIHITED VAL. OF RATIO 
RTHAX*HAX VALUE OF RATIO. 
RW»WHEEL RADIUS, (H). 

T“CURRENT TIHE, (SECS). 
TBF,TBR»BRAKING TORQUES, FRONT 
AND REAR WHEELS, (N-H) 
TBRP*VAL OF TBR USED TO PRNT . 
TIHARR ( I )“VAL OF TIHE USED IN 
IN COHP. DRIVING CYCLE VEL 
ll=RATIO CONTROLLER OUTPUT. 
VROR “ERROR BETWEEN DRIVING 

CYCLE AND VEH . VEL'S,H/S 
VRRHS“RHS VEL ERROR OVER 
DRIVING CYCLE. 

VSPR=VSP . 

VSQ=SUH OF SQ'S OF VEL ERRORS 
VWIND=PRESENT VAL OF WIND VEL 
XI “ENG . SPEED , RAD/SEC . 
X2=DEVELOPED ENG TORQ . ,N-h . 
X3=XMISSI0N RAT lO(UNLIHITED) 
X5=STATE OF INTEGRATOR IN 
ENG SPEED CONTROLLER. 

Y(I) “PRESENT VALUES OF STATES 
USED BY NIN. 


HIN FUEL CONSUHPTION. 

PL=THROTTLE SETTING. 

RA“REAR AXLE RATIO. 

R HS»COHP UTES RIGHT HAND SIDE OF 
STATE EQNS. 

RNH1“REAL VALUE OF NH1 . 
RSPHAX“HAX ALLOW VALUE OF RSP. 
RSPROP*CONTRIB TO RSP FROH PROP 
PART OF RSP PI CONTROLLER 
RTHIN»HIN VALUE OF RATIO. 
SIHPER“SIHULATION LENGTH, (SECS) . 
TAUL*TIHE CONST OF ENG. TORQ,(S) 
TBHAX“CONST. RELATING PEDL. POSN. 
AND BRAKING TORQUE. 

TIHE=CURRENT TIHE, (SECS). 

TH=ENG . TORQUE FROH ENG. HAP. 
VDC(I)“DR CYCLE VEL PROFILE, H/S. 
VERR=DIFF BET. AVER. OF PRESENT 
AND NEXT SAHPLE OF DR. CYC. 
VEL. AND VEH. VEL., (H/S). 
VSP “COHP UTES PRESENT VALUE OF 
DRIVING CYCLE VEL., (H/S). 

VW( I )*WIND VEL OVER DR CYCLE, H/S 
W=UT. OF VEH. AND WHEELS, (N). 
X1P“VAL OF XI USED FOR PRINTING 
X2P“VAL OF X2 USED FOR PRINTING. 
X4“DER IVATI VE OF X3 
X6=STATE OF INTEGRATOR IN PEDAL 
CONTROLLER . 


3K 1 4 ])( 1 * X * ]|t 3jt IX ]|l ]|C * ]|[ Xt ]|( ]|( Xt XtX^ Xt ^ 3(t * ]|C ]|( ]|( Xt 1|( Xt 3|t lit Xt Xt Xt Xt Xt lit lit lit Xt Xt Xt Xt Xt ]|t lit 


XXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXX 
XXXXXXXXXXXXXXX ADDITIONAL SYSTEH VARIABLES *XXXtX****Xt*XtXt*X*** 

xxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxx 


IWRTE=CHANGES DATA OUTPUT, “0 
GIVES FULL OUTPUT, “1 
GIVES REDUCED OUTPUT 
VVELP “VALUE OF VVEL USED TOR 
PRINTING. 

WALP=FILTER CONST. FOR ENG. 
SPEED SET POINT. 


NRUN=NG OF RUNS OF SIHULATION 
PER PROGRAH EXECUTION. 
VVEL=VEHICLE VELOCITY. 

PD“PEDAL POSITION. 

XALP=FILTER CONST. FOR ENGINE 
SPEED CONTROL LOOP . 
PALP“F1LTER CONST. FOR PEDAL 
VARIATIONS. 






^ ^ ^ ^ ^ ^ ^ ^ ^ ^ ^ ^ ^ ^ ^ ^ ^ ^ ^ ^ ^ ^ ^ ^ jh ^ ^ ^ ^ ^ ^ ^ ^ ^ ^ ^ ^ 

DECLARE COHHONS, DIHENSIONS, REALS, EXTERNALS 

COHHON LL, PEDL, VW(501> ,VDC(2Ql)l) ,TBF, TBR, BETA(50i> ,C (91 ) , JE , TAUL ,K 
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0111 

0112 

0113 

0114 

0115 

0116 

0117 

0118 

0119 

0120 
0121 
0122 

0123 

0124 

0125 

0126 

0127 

0128 

0129 

0130 

0131 

0132 

0133 

0134 
01 35 

0136 

0137 

0138 

0139 

0140 

0141 

0142 

0143 

0144 

0145 

0146 

0147 

0148 

0149 

0150 

0151 

0152 

0153 

0154 

0155 

0156 

0157 

0158 

0159 

0160 
0161 
0162 

0163 

0164 

0165 


1CR,BP,KP,KR,HP,HT,HV,RA,RW,KA,KT , RHO ,G , CD, A, W ,HU , KG ,KPDI , T IHARR < 20 
101 ) ,DCP ,TBHAX,KCEI ,KCEP ,KPDP ,RSP ,RNHi 
COHHON/CC/P I OLE , VVEL 
COHHON/DD/PD 

REAL JE,KA,KCR ,KP ,KR ,KT ,HP ,HU,HT ,HV,KG,KPDI ,KCEI ,KCEP ,KPDP 
COHHON/AA/I 

COHHQN/BB/ENGHAP (19,10), ENGSP ( 19 ) , PEBPCT (10) , FUR ATE ( 19 , 1 0 ) ,PEDPOS ( 
121 ) ,0PT8P (21 ) ,RTHIN,RTHAX 
DIHENSION Y(15) 

REAL JA, JT , JWF, JWR,HUF,HWR 

C EXTERNAL USED TO DENOTE SUBROUTINE NAHE SPECIFIED IN A SUBROUTINE 
EXTERNAL RHS 

C 

C FORHAT STATEHENTS. 

400 FORHAT (8F10 . 4 ) 

401 FORHAT(F10 .4,515) 

405 FORHAT ( 16F5. 1) 

410 FORHAT (10F8 . 1 ) 

415 FORHAT (10E8. 2) 

500 FORHAT ( 1H1 ,36HSIHULATI0N OF HEAT ENGINE/CUT SYSTEH) 

501 FORHAT ( 1H0 ,3X, 2HA*,F8 . 4,2X ,3HBP= ,F8 . 4,2X , 3HCD* , F8 . 4 , 3X , 2HG* ,F8 .4,2 
IX , 3HJA* ,F8 . 4 ,2X ,3HJE= , F8 . 4 ,2X ,3HJT* ,F8 . 4 ,2X ,6HP IDLE* , F8 . 4 ) 

502 FOR HAT ( 1 HO , 1 X , 4H JWF* , F8 . 4 , 1 X , 4H J WR= , F8 . 4 , 1 X , SHKCEI * , F8 . 4 , 1 X , SHKCEP 
l*,Fe 4,1X,4HKCR*,F8.4,2X,SHKPDI=,F8.4,2X,SHKPDP*,F8.4) 

503 FORHAT (1H0,2X,3HKR=,F8 . 4,2X,3HHP=,F8 . 4,2X ,3HRA=,F8 . 4 ,2X , 3HRW* , F8 . 4 
1 ,3X ,2HW* ,F1? . 4 ,2X , 4HDCP* ,F8 . 4 , 2X , 3HKG* ,F8 . 4 ,2X,3HKP* ,F8 . 4 ) 

504 FORHAT ( 1H0,6X, 3HHU* , F8 . 4 , 5X , 4HRH0* , F8 . 4 , 3X , SHTAUL* , F8 . 6 , 3X , 6HTBHAX 

1*F8 . 4 ) 

505 FORHAT (1H0,16HWIND VELOCITY * ,F8 . 4 ,5X , 14HGRADE ANGLE * ,F6.2) 

506 FORHAT ( 1H0 , 16HEFFICIENCIES ARE , 10X ,24HREAR AXLE/DIFFERENTIAL- ,F7. 
14 , 5X , 14HTRANSHISSI0N- ,F7.4> 

507 FORHAT ( lHO , 27HRATI0 SET POINT LIHITS ARE-,2X,2F6. 3) 

510 FORHAT (1HO,23HSIHULATION INTERVAL IS ,F7.2,8H SECONDS) 

511 FORHAT (1H0,17HTHE INTERVAL HAS ,I6,9H SEGHENTS) 

520 FORHAT (1H0 ,33HJNITIAL CONDITIONS FOR SIHULATION) 

521 FORHAT ( 1H , 1X,7H0HEGAE=,F8 4,5H, TE*,F8.4,5H, R=,F6.2,7H, RDOT* , F 

16 . 2 ,9H, SP INT=,F6.2,8H, PEDAL*, F7. 3) 

530 FORHAT ( 1H1 , 4HTIHE , 2X , 6H0HEGAE , 3X , 6HOHEGSP , 3X , 2HEM, 6X , 2HTE , 6X , 2HTH , 
1 6X , 2HTH , 6X , 2HTB , 6X , 1HV , 5X , 3HVSP , 1 X , 7HV ERROR , 2X , 4HPEDL , 5X , 1HU , 4X , 2 
1HRT , 4X , 3HRSP , 5X , 2HER , 2X , 4HFUEL , 3X , 2HXS, 2X , 2HX6 ) 

531 F OR HAT ( 1H0 , 1 X , 5HWALP * , F8 . 4 , 1 OX , 5HXALP * , F8 . 4 ) 

532 FORHAT (1H ,F5 1 , IX ,6(F7 . 1 , IX ) ,F6 . 1 , IX, 3(F6 . 2, IX) ,F6 . 2, IX, F6 . 2 , IX , 2 
1(F5 2,1X) ,F6.3,1X,F4.1,1X,F4.2,1X,F4.1) 

533 FORHAT (1H0,20HRHS VELOCITY ERROR = , F8 . 3 , 5X , 26HAVER AGE FUEL CONSUHP 
1TION * ,F8 . 3 , 5X , 24HRHS ENGINE SPEED ERROR =,F8.3) 

540 FORHAT ( 1H ,F12 8) 

541 FOR HAT ( 1H 1 , 4HT I HE , 2X , 6H0HEGAE , 1 X , 6H0HEGSP , 2X , 2HEW , 5X , 2HTE , 4X , 2HTH , 
14X , 2HTB , 5X , 1HV , 4X , 3HVSP , 2X ,4HVERR , 2X , 4HPEDL , 3X,2HRT,2X, 3HRSP ) 

542 FORHAT (1H , F5 1 ,3 ( IX ,F6 1 ) ,3 ( IX ,FS 1 ) , 4( IX ,F5 2 ) , 2 ( IX , F 4 2 ) ) 

C ************************iMt**************************************** 

C 

C RFAD SYSTEH INPUTS. 

C READING IN PARAHETER VAlUF.S 

READ(5 ,400 ) A ,BP ,CD ,G , JA, JE, JT ,P IDLE 
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0166 

0167 

0168 

0169 

0170 

0171 


0172 

0173 

5 

0174 

0175 

C 

0176 

0177 

0178 

C 

0179 

0180 

c 

0181 

0182 

0183 

0184 

c 

0185 

0186 

c 

0187 

11 

0188 

0189 

c 

0190 

0191 

c 

0192 

12 

0193 

0194 

0195 

c 

0196 

13 

0197 

0198 

0199 

C 

0200 

0201 

0202 

0203 

C 

0204 

0205 

C 

0206 

131 

0207 

0208 

C 

0209 

14 

0210 

C 

0211 

c. 

0212 

0213 

0214 

0215 

0216 
0217 

C 

0218 

0219 

0220 

C 


READ(5, 400 ) KR,MP,RA,RU,W,DCP,KG,KP 
READ(5 , 400 ) «U,RHO,TAUL,TBhAX 
READ(S,400) KA,KT,RTHIN,RTMAy 
R EAD (5,401) PELT , N , I NPR IN , MET , I WR TE ,NRUN 
READ(5 ,400) VWIND,BETA( 1 ) 

DO S 1*2,501 
BETA( I )*BETA < 1 ) 

VW( 1 )=VWIND 
READ INITIAL STATES. 

READ(S,41S) X3,X4 

SAVE INITIAL STATES FOR SECOND RUN OF SIMULATION. 

X3I*X3 

X4I=X4 

INITIALIZE VEHICLE VELOCITY. 

VVEL*0 . 0 

READ SPEEDS ON ENGINE MAP. 

READ(S,400) (ENCSP < I), I* 1,8) 

READ(5 ,400 ) (ENGSP ( I ) , 1*9 , 16) 

READ (5,400) (ENCSP ( I ), 1=17, 19) 

CONVERT ENGINE SPEEDS TO RAD/SECS. 

DO 11 1=1,19 

ENGSP ( I )»ENGSP (1)40. 10472 

READ PEDAL PERCENTS ON ENGINE MAP . 

READ(5,405) (PEDPCT ( I ) , 1=1 , 10 ) 

READ ENGINE MAP TORQUES CORRESPONDING TO ENGSP(I) AND PEDPCT(J). 

DO 12 1=1,19 

READ<5, 41 0 ) (ENGMAP ( I , J ) , J=1 , 10 ) 

CONVERT ENGINE TORQUE TO N-M . 

DO 13 1=1,19 
DO 13 J=l,10 

ENGMAP ( I , J) =ENGMAP ( I , J ) * 1 . 35575 
READ PEDAL PERCENTS ON MIN FUEL CURVE. 

READ(5 , 405 > (PEDPOS( I ) , 1=1 , 16) 

READ(S ,405) (PEDPOS( I ) , 1=17 ,21 ) 

READ ENGINE SPEED VALUES ON MIN FUEL CURVE. 

READ(5 ,400 ) (OPTSP ( I ) , 1=1 ,8) 

READ(5,400) (OPTSP ( I ) , 1=9, 16 ) 

READ(5,400) (OPTSP ( I ), 1=17 ,21 ) 

CONVERT SPEED VALUES TO RAD/SEC. 

DO 131 1=1,21 

OPTSP ( I )=OPTSP (1)40 . 10472 

READ IN FUEL CONSUMPTION RATES. 

DO 14 1=1,19 

READ(S ,410 ) ( FUR ATE ( I ,J) ,J=1 ,10) 

******«***»*******)»******* ili*********************************^**** 

SET UP SAE DRIVING CYCLE. 

Nf11=N-l 
RNhl*NMl 
DO 20 1=1, N 
J = I-1 
R J=J 

COMPUTE TIME AT EACH STEP IN SIMULATION. 

TIMARR ( I >=R J4DCP/RNM1 
T=TIMARR( I) 
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0221 

0222 

0223 

0224 

0225 

0226 

0227 

0228 

0229 

0230 

0231 

0232 

0233 

0234 

0235 

0236 

0237 

0238 

0239 

0240 

0241 

0242 

0243 

0244 

0245 

0246 

0247 

0248 

0249 

0250 

0251 

0252 

0253 

0254 

0255 

0256 

0257 

0258 

0259 

0260 
0261 
0262 

0263 

0264 

0265 

0266 
0267 
0263 

0269 

0270 

0271 

0272 

0273 

0274 

0275 


C FIND DRIVING CYCLE VEL . AT EACH STEP IN SIMUL. AND STORE IN VDC<I> 
141 IF(T .GT . 14 . 0) GO TO IS 
VDC < I ) = 1 . 436794T 
GO TO 20 

15 IF<T GT.64.0) GO TO 16 
VDC (I >=20 . 1 IS 

GO TO 20 

16 IF(T .GT . 74 . 0 > GO TO 17 

VDC < I )*20 . 115-0 . 447#< T-64 . 0 ) 

CO TO 20 

17 IF< T . GT . 83 . 0 ) GO TO 18 
VDC<I>=15. 645-1 .738HKT-74 .0) 

GO TO 20 

18 IFtT.GT. 108.0) GO TO 19 
VDC< I > =0 . 0 

GO TO 20 

19 T =T-i 08 . 0 
GO TO 141 

20 CONTINUE 

C ####*#*#*#**#******#***####**#***#*****#******#**#**************** 

C 

C OVFRALL LOOP TO RUN SIMULATION TWICE . 

DO 60 JRUN=1,NRUN 

C SET STATES EQUAL TO INITIAL STATES FOR RUN. 

X3=X3I 
X4=X4I 
VVEL=0 . 0 

C READ IN CONTROLLER GAINS FOR THIS RUN. 

READ(5,400> JWF, JWR ,KCEI ,KCE> ,KCR ,KPDI ,KPDP 
READ(5 ,400) WALP ,X ALP , PALP 
C PRINTING INPUT PARAMETERS 

WRITE(6 ,500 ) 

WRITE (6 ,501) A > BP > CD,G > JA > JE,JT > PIDLE 
WRITE (6, 503) KR ,MP ,RA, RW, W,DCP , KG, KP 
WRITE<6,504) MU ,RHO ,TAUL ,TBMAX 
WRITE(6,506) KA,KT 
WRITE (6 ,507) RTMIN ,RTMAX 
WRITE<6,505) VWIND,BETA< 1 > 

L=N-i 

Rl.=L 

C PRINT TIME INTERVAL OF SIMULATION. 

SIMPER =RL*DELT 
WRITE(6,510) SIMPER 
WRITE<6,511> L 

WRITE(6,502> JWF , JWR ,KCEI ,KCEP ,KCR ,KPDI ,KPDP 
WRITE <6,530 WALP , XALP 

C COMPUTE INITIAL VALUE OF ENGINE SPEED. 

X1=PHI4(PIDLE) 

WQLD=Xi 
WNEW=Xi 
X1LD=X1 
X1NW-X 1 

C COMPUTE INITIAL VALUE OF DEVELOPED ENGINE TORQUE. 

X2=PHI3( P IDLE , XI ) 

C COMPUTE INITIAL VALUE OF RATIO SET POINT. 
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xs*o . 0 

TC*0 .0 

COMPUTE INITIAL DRAG AND ROLLING RESISTANCE. 

D=0 . 5*<RHO/G)*CD*A*( < UVEL+VW( 1 ) )**2) 

IF((VW(1)+WEL> LT.O 0) D«-D 

R=MU*W#( 1 . 0+1 4E-3*WEL+i . 2E-S*VVEL*VVEL ) 

INITIALIZE PEDAL CONTROLLER INTEGRATOR. 

X6=P IDLE 
WRITE <6 ,520 ) 

WRITE(6,S21) X1,X2,X3,X4 , X5,X6 
INITIAL SIMULATION TIME. 

T*0 0 

COMPUTE PEDAL CONTROLLER OUTPUT. 

USPR*VSP(T> 

VERR=VSPR-VV)EL 

PL*X6+KPDP*VERR 

POLD=PL 

PNEW«PL 

PD=PL 

IF (PL . LT . P IDLE) PL=PIDLE 

COMPUTE THROTTLE POSITION (OUTPUT OF GAIN EQUALIZER). 
ZIDLE=P IDLE+0 .001 
GO TO 24 

IF (PL .GT . 63 . 29) GO TO 21 


0300 IF (PL . GT . 12 . 43) GO TO 22 

0301 IF (PL . GT . ZIDLE) GO TO 29 

0302 GO TO 24 

0303 21 PL=i . 0874PL-8.7 

0304 GO TO 24 

0305 22 PL=0 . 295#PL+41 . 33 

0306 GO TO 24 

0307 29 Pl..=PL 

0308 24 CONTINUE 

0309 C LIMIT THROTTLE POSITION. 

0310 1F(PL.GT. 100.0) PL=100 0 

0311 C COMPUTE INITIAL ENGINE SPEED SET POINT. 

0312 QMEGSPsUNEU 

0313 C COMPUTE INITIAL RATIO SET POINT. 

0314 RSP=X5 

0315 RSPOLD=RSP 

0316 C COMPUTE RATIO SET POINT LIMITS. 

0317 RSPMAX=RTMAX*((KP+KCR*KR*KG)/(KCR*KR*KG> ) 

0318 RSPMIN*RTMIN#( ( KP+KCR *KR*KG ) / ( KCR*KR*KG ) ) 

0319 C COMPUTE INITIAL OUTPUT OF RATIO CONTROLLER, ENGINE SPEED SET POINT 

0320 C USED FOR PRINTING, ENGINE SPEED AND RATIO ERRORS, INTERNAL 

0321 C ENGINE TORQUE, FUEL CONSUMPTION. 

0322 U-KCR* ( RSP-PHI5( X3 ) ) 

0323 0MPR=PHI4(PL) 

0324 EW-GMPR-X 1 

0325 ER=RSP-X3 

0326 TM=PHI3(PL,Xt) 


0276 

0277 

0278 C 

0279 

0280 
0281 

0282 C 

0283 

0284 

0285 

0286 C 

0287 

0288 C 

0289 

0290 

0291 

0292 

0293 

0294 

0295 

0296 C 

0297 

0298 

0299 
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0327 

0328 

0329 

0330 

0331 

0332 

0333 

0334 

0335 

0336 

0337 

0338 

0339 

0340 

0341 

0342 

0343 

0344 

0345 

0346 

0347 

0348 

0349 

0350 

0351 

0352 

0353 

0354 

0355 

0356 

0357 

0358 

0359 

0360 

0361 

0362 

0363 

0364 

0365 

0366 

0367 

0368 

0369 

0370 

0371 

0372 

0373 

0374 

0375 

0376 

0377 

0378 

0379 
03R0 
0381 
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FUEL*PHI6(X1,PL> 

MV*W/G+( JWR+JWF) / (RW4RW) 

MWT/<RA*RW) + (RA*JA)/(KT*RW) + <RA#RW*MV)/<KA#KT) 

C COMPUTE INITIAL BRAKING TORQUE. 

TBR=0 . 0 
TBF*0 .0 

IF < PD . LT . P IDLE ) TBR*- ( PD-P IDLE ) *TBMAX 
C COMPUTE NO. OF ITERATIONS IN COMPUTER SIMULATION. 

NL=N-i 

C SET UP VECTOR OF CURRENT VALUES OF STATES FOR* NUMERICAL INTEGR . 

Y ( 1 )=Xi 
Y (2)=X2 
Y(3)=X3 
Y(4)«X4 

C INITIAL OLD STATES OF CONTROLLER INTEGRATORS. 

X50LD-X5 

X60LD-X6 

C DETERMINE NO. OF OUTPUTS TO BE PRINTED (FULL OR REDUCED) AND 
C PRINT APPROPRIATE HEADING. 

IF(IWRTE.EQ.O) GO TO 32 
WRITE (6, 541 ) 

GO TO 34 

32 WRITE(6,S30> 

34 CONTINUE 

C SET UP NO. OF LINES OF OUTPUT PRINTED PER PAGE. 

JPR=0 

NPRMAX«60*INPRIN 

NPR*0 

C COMPUTE VALUES OF VARIABLES USED FOR PRINTING. 

TINE=0.0 

X1P=X1 

X2P*X2 

TBRP=TBR 

VVF.LP*VVEL 

C PRINT FIRST LINE OF OUTPUT. IF MET=i , RESULTS ARE IN METRIC. 

WRITE <6, 333) 

333 FORMAT <4H****> 

IF(MET.EQ.O) XiP=Xi*9.5493 
IF (MET .EQ . 0 ) OMPR*OMPR*9 5493 
IF(MET.EQ.O) EW*EW*9.S493 
IF (MET . EQ . 0 ) X2P»X2*0 .73746 
TF (MET . F.Q . 0 > TM*TM*0 . 73746 
IF (MET .EQ . 0 ) VVELP=VVEL*2. 23714 
IF ( MET . EQ . O > TBRP=TBR*0 .73746 
IF (MET . EQ . 0 ) VSPR=VSPR*2. 23714 
IF(MET.EQ.O) VERR*VERR*2. 23714 
IF ( IWRTE . EQ . 0 ) GO TO 36 

WRITE (6 ,542) TIME ,X1P ,OMPR ,EW , X2P ,PL,TBRP , VVELP , VSPR , VERR ,PD , X3 , RS 
IP 

GO TO 37 

36 WRITE (6, 532) TIME ,X1P ,OMPR ,EW,X2P ,TM, PL , TBRP , VVELP , VSPR , VERR , PD , U , 
1X3, RSP,ER, FUEL, X5,X6 

37 CONTINUE 

C INITIALIZE VELOCITY SUM OF SQUARES AND AVER. FUEL CONSUMPTION. 

VSQ=0 . 0 



PAGE 0008 HCVT 10:14 AM THU., 21 HAY , 1981 


71 


0382 


FUAV-0 . 0 



0383 


ENGER»0 C 



0384 

C 

#**#**1^********************************************************* 

0385 

C 




0386 

C 

BEGIN SIMULATION. 



0387 


DO 50 L*1,NL 



0388 


NPR»NPR+i 



0389 


JPR*JPR+i 



0390 


LL«L+1 



0391 


NV«4 



0392 


PEDL-PL 



0393 

C 

PERFORM NUMERICAL INTEGRATION OF STATE EQNS . OVER CURRENT 

TIME 

INT 

0394 


CALL NIN(RHS,NV,T,DELT,Y> 



0395 

C 

INCREMENT TIME. 



0396 


RL»L 



0397 


TIME»RL*DELT 



0398 

C 

UPDATE STATES WITH RESULTS FROM NUMERICAL INTEGRATION. 



0399 


X1*Y( 1 ) 



0400 


X2*Y (2> 



0401 


IF(Y(3) .GT.RTMAX) Y(3)«RTMAX 



0402 


1F(Y(3> LT.RTMIN) Y<3)*RTMIN 



0403 


X3*Y <3 ) 



0404 

c 

COMPUTE NEW VEHICLE VELOCITY. 



0405 


RLIM=PHIS(X3) 



0406 


VVEL=RA*RW*RLIM*Xi 



0407 

c 

CALCULATE CURRENT VALUES OF SYSTEM VARIABLES. 



0408 


VSPR=VSP (T ) 



0409 


OMEGSP=WNEW 



0410 


ll=KCR*(RSP-RLIM> 



0411 


OMPRbUNEU 



0412 


£W=WNEW-Xi 



0413 


ER=RSP-RLIM 



0414 


TM=PHI3(PL,X1 ) 



0415 


D=0 . 5*(RH0/G)*CD*A*< (VVEL+VW< 1) )»*2> 



0416 


I F ( < VW ( 1 ) +V VEL ) . LT .0.0) D=-D 



0417 


R=MU»W*( 1 . 0+1 . 4E-34VVEL+1 . 2E-5*VVEL*VVEL ) 



0418 


FUFL»PHI6(Xi,PL) 



0419 


TBR«0. 0 



0420 


IF (PD . LT . PIDLE) TBR=-(PD-PIDLE)*TBMAX 



0421 

c 

IS IT TIME TO PRINT AN OUTPUT? 



0422 


IF( JPR ,LT . INPRIN) GO TO 40 



04?3 

c 

IF YES, COMPUTE PRINT VALUES, CONVERT UNITS IF REQUESTED, 

AND 

PRNT 

0424 


XlP=Xi 



0425 


X2P=X2 



0426 


TBRP=TBR 



0427 


VVELP-VVEL 



0428 


VROR*VSPR-VVEL 



0429 


IF (MET ,EQ . 0 ) X1P“X1*9 . 5493 



0430 


IF (MET .EQ . 0 > OMPR=OMPR#9 5493 



0431 


IF(MET.EQ.O) EW=EW*9.5493 



0432 


IF ( MET . EQ . 0 ) X2P*X2#0 . 73746 



0433 


IF ( MET . FQ . 0 ) TM*TM*0 73746 



0434 


IF (MET EQ.0) VVELP=VVEL*2 23714 



0435 


IF(MET.EQ.O) TBRP=TBR*0 . 73746 



0436 


IF(MET.EQ.O) VSPR=VSPR*2 . 23714 
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0437 1F(MET . EQ . 0 > VROk«=VRCiR*2 . 23714 

0438 IF ( IWRTE .EQ . 0 ) GO TO 38 

0439 WRITE(6,542) TIME,X1P ,OMPR ,EW ,X2P ,PL,TBRP ,WELP ,VSPR >VROR ,PD,RLIM, 

0440 1RSP 

0441 GO TO 3? 

0442 38 WRITE(6,532) TIME,X1P ,0MPR,EW,X2P,TM,PL,TBRP,VVELP,VSPR,VR0R,PD,U, 

0443 1RLIM,RSP , ER,FUEL,X£,X6 

0444 39 CONTINUE 

0445 JPR«0 

0446 40 CONTINUE 

0447 C PRINT PAGE HEADING IF APPROPRIATE. 

0448 IF< IWRTE. EQ.O) GO TO 41 

0449 IFtNPR EQ.NPRMAX) WRITE<6,541) 

0450 GO TO 42 

0451 41 IF(NPR .EQ.NPRMAX) WRITE<6,530) 

0452 42 CONTINUE 

0453 IF(NPR EQ.NPRMAX) NPR-0 

0454 r. a***************************************************************** 

0455 C COMPUTE OUTPUT OF PEDAL CONTROLLER. 

0456 C VEL. ERROR IS BASED ON AN AVER OF PRESENT AND FUTURE VEL SET PTS. 

0457 VERR«< <VSP (T+DELT )+VSP <T ) >/2 . 0)-VVEL 

0458 C COMPUTE INTEGRAL, PROP. AND TOTAL OUTPUT OF PI CONTROLLER. 

0459 X6NEW«X60LD+KPDI*VERR*DELT 

0460 PEDPRP»KPDP*VERR 

0461 PL=X6NEW+PEDPRP 

0462 C ADJUST OUTPUT WITH ANTI-WIND/UP LOGIC. 

0463 IF(PL.LE. 100 .0) GO TO 25 

0464 IF(PEDPRP.GE 100.0) GO TO 23 

0465 X6NEW*1. 00 . 0-PEDPRP 

0466 GO TO 25 

0467 23 X6NEW=X60LD 

0468 PEDPRP=100 . 0-XfaNEW 

046? 25 CONTINUE 

0470 PL=X6NEW+PEDPRP 

0471 C FILTER PEDAL VARIATIONS. 

0472 PLNEM“PALP*PLOLD+( 1 . -PALP )*PL 

0473 PL=-PLNEW 

0474 PLOl D=PLNEW 

0475 PD*PL 

0476 IF(PL.LT PIDLE) PL=PIDLE 

0477 X60LD-X6NEW 

0478 X6=X6NEW 

047? C. COMPUTE THROTTLE POSITION USING GAIN EQUALIZER. 

0480 GO TO 28 

0481 IF(PL .GT .63 . 29) GO TO 26 


0482 IF < PL. GT. 12.43) GO TO 27 

0483 IF ( PL . GT . Z1DLE ) GO TO 31 

0484 GO TO 28 

0485 26 PL=) 087*PL-8 7 

0486 GO TO 28 

0487 27 PL=0 2954PL+41 .33 
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0488 CO TO 28 

0489 31 PL -P'. 

0490 28 CONTINUE 

0491 C a#*****#********#***#**##**##**#**#**##***#*###**##*##*####**####* 

0492 C COMPUTE OUTPUT OF ENGINE SPEED CONTROLLER. 

0493 C SAVE CURRENT RATIO SET POINT. 

0494 RSPOLD-RSP 

0495 C COMPUTE INTEGRAL, PROP. AND TOTAL OUTPUT OF PI CONTROLLER. 

0496 C USE NEC. OF ERROR SINCE RATIO AND ERROR VARY INVERSELY. 

0497 C FILTER ENGINE SPEED SET POINT AND ENGINE SPEED. 

0498 WNE W« WALP *WClLD+ ( 1 . -WALP ) *PH 1 4 ( P L ) 

0499 WOLD-WNEW 

0500 X1NW»XALP*X1LD+<1 ,-XALP)*Xi 

0501 X1LD-X1NW 

0502 X5NEW=X50LD-KCEI*( WNEW-X1NW )#DELT 

0503 RSPROP— KCEP*(WNEW-X1NW> 

0504 RSP-X5NEW+RSPR0P 

0505 C ADJUST OUTPUT WITH ANTI-WIND/UP LOGIC. 

CS06 IF (RSP . GE .RSPMAX) GO TO 30 

0507 IF (RSP . GT . RSPMIN) GO TO 35 

0508 DI FF “X5NEW-XS0LD 

0509 IF(DIFF.GT.O.O) GO TO 3S 

0510 XSNEW-X50LD 

0511 RSP«RSPHIN 

0512 GO TO 55 

0513 30 IF (RSPROP. GE. RSPMAX) GO TO 33 

0514 X5NEW*RSPMAX-RSPRQP 

0515 GO TO 35 

0516 33 X5NEW-XSGLD 

0517 35 CONTINUE 

0518 RSP*X5NEW+RSPRGP 

0519 GO TO 53 

0520 C INHIBIT RATIO SET POINT CHANGE IF IT MAKES 

0521 C VEHICLE VELOCITY ERROR WORSE. 

0522 55 IF(VERR) Si, 52, 52 

0523 51 IF (RSP-RSPOLD) 53,54,54 

0524 52 IF (RSP-RSPOLD) S4,53,S3 

0525 54 RSP«RSPOLD 

0526 X5NEW«X50LD 

0527 53 CONTINUE 

0528 XS0LD«X5NEW 

0529 X5«XSNEW 

0530 C ****************************************************************** 

0531 C COMPUTE SUM OF SQUARES OF VEL AND ENGINE SPEED ERRORS, AND 

0532 C TOTAL FUEL CONSUMPTION. 

0533 VSQ«VSQ+VERR*VERR*DELT 

0534 ENGER-ENGER+EW*EW*DELT 

0535 50 FUAV«FUAV+FIJEL*DELT 

0536 C COMPUTE VEL RMS ERROR, AND AVERAGE FUEL CONSUMPTION RATE. 

0537 VRRMS*SQRT (VSQ/SIMPER ) 

0538 FUAV*FUAV/SIMPER 

0539 ENGE R*SQPT (ENGER/SIMPER ) 

0540 60 WRITE (6, 533) VRRMS ,FUAV ,ENGER 

0541 STOP 

0542 END 
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0543 

0544 

0545 

0546 

0547 

0548 

0549 

0550 

0551 

0552 

0553 

0554 

0555 

0556 

0557 

0558 

0559 

0560 

0561 

0562 

0563 

0564 

0565 

0566 

0567 

0568 

0569 

0570 

0571 

0572 

0573 

0574 

0575 

0576 

0577 

0578 

0579 

0580 

0581 

0582 

0583 

0584 

0585 

0586 

0587 

0588 

0589 

0590 

0591 

0592 

0593 

0594 

0595 

0596 

0597 


74 


SUBROUTINE NIN<GR,N,X,DX,Y) 

C ft***************************************************************** 

C NUMERICAL INTEGRATION SUBROUTINE. THIS SUBROUTINE INTEGRATES THE 

C STATE EQUATIONS USING A VARIABLE STEP SIZE RUNGE-KUTTA ALCORITHH . 

C GRkNAHE OF SUBROUTINE WHICH CONFUTES CURRENT DERIVATIVES OF STATES 

C N-NO. OF EQNS . TO 8E INTEGRATED. 

C X-CURRENT TINE. 

C DX=TIHE STEP SIZE. 

C Y* VALUES OF STATES AT END OF INTEGRATION INTERVAL. 

C ****************************************************************** 

DIMENSION S(15>,YP(15),Y1(15),E(15>,Z(15),XK<15,3) ,YMAX(15) , Y0(15) 
1,P0(15),Y(1S),P<15) 

DXHAX-DX 
DXHIN*1 0E-4 
ERRHIN»0 .000005 
XF*X+DX 

IF (DXHAX . EQ .DXHIN) GO TO 300 
X0«X 

IF ( X) 10 , 1 0 ,30 
10 HT*XF 

DO 20 1*1 ,N 

20 YHAX< I )*ABS( Y( I ) ) 

30 H=HT 
40 X*X0 

H*X0+AHIN1 < H , DXHAX , DX ) -X0 
DO 50 1*1 ,N 
50 Y0(I)*Y(I) 

CALL GR(Y,P,X,X0) 

DO 60 1*1 ,N 
P0<I)*P(I> 

60 Y(I)=Y0(I)+0. 5*H»P0 ( I ) 

X*X0+0 5*H 
CALL GR(Y,P,X,X0) 

DO 80 1*1 ,N 
S(I)*?. 0*P(I)+P0<I) 

80 Y<I)*Y0<I)+0.5*H*P<I) 

CALL CR(Y,P,X,X0) 

DO 90 1*1, N 

S< I )*2 . 0*P ( I )+S(I ) 

90 Y<I)*Y0<I)+H*P<I) 

X*X0+H 

CALL GR<Y,P,X,X0) 

DO 100 1*1, N 

100 YP ( I )*Y0 < I )+H*<P<I )+S< I ) )/6 . 0 

110 X*X0+0.2S*H 

DO 120 1*1, N 

120 Y(I)*Y0(I)+0 25*H*P0(I) 

CALL GR<Y.P,X,X0) 

DO 130 1*1 ,N 

S< I )*2 . 0*P< I )+P0( I ) 

130 Y ( I )*Y0 < I )+0 . 25*H*P ( I ) 

CALL GR < Y ,P , X ,X0 ) 

DO 140 1*1, N 
S<I>*2 0*P(I)+S<I) 

140 Y(I)*Y0(I)+0 . 5*H*P ( I ) 
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X«X0 + O ,5*H 

059? 


CALL GR ( Y ,P ,X ,XQ ) 

0600 


DO 150 1*1, N 

060) 


Yl(I)*Y0U)+0 ,5*H*(P(I)+S(I))/6.0 

060? 

150 

Yd> = Yid) 

0603 


CALL CR(Y,P,X,XQ> 

0604 


1)0 160 1 = 1, N 

0605 


S(I)«P(I) 

0606 

160 

Y(I )*Yld) + 0 ,25^H*P(I) 

0607 


X-X0+0 75*H 

0608 


CALL GR < Y > H , X , X 0 ) 

060? 


DO 170 1=1, N 

0610 


&(I >«2 0*P( I)+S( I) 

0611 

170 

Y(I)=Y1(I)^0 .25*H*P<I) 

061? 


CALL GR < Y,P , X,X0) 

0613 


DO 180 1*1, N 

0614 


S(1 >*2. 0*P(I >+S< I ) 

0615 

180 

Yd>-Yld) + 0.5*H*Pd> 

0616 


X*X0+H 

0617 


CALL GR<Y,P ,X,X0) 

0618 


R = 0 . 0 

0619 


DO 190 1=1 ,N 

0b20 


Y (I ) = Y 1 < I ) +U . 5*H* < P d ) +S d > > /6 . 0 

0621 


Ed> = (Yd)-YPd))/15.0 

0622 


7(1) =AMAXi ( YrtAX< I ) , Abb ( Y ( I > ) ) 

0623 


IF<Z(1) EQ.O .0) GO TO 190 

0624 


R=AMAX1 (R , AHSlE( I ) )/Z< I ) ) 

0625 


IF (ERRMIN-R ) 185, 1?0>190 

0626 

18S 

IF < H-DXMIN ) 190,190,270 

0627 

190 

CONTINUE 

0628 


DO 200 1=1 >N 

0629 


Y<I >=Y(I >+E(I> 

0630 

200 

YMAX ( I )*Z(I ) 

0631 

205 

X0*X0+H 

0632 


lF(XF-XO) 210,210,220 

0633 

210 

RETURN 

0634 

220 

IF (R-ERRrilN) 230,230,240 

0635 

230 

H=H+H 

0636 

240 

IF ( XF-XO-H ) 250,250,40 

0637 

250 

HT=H 

0638 


H=XF-X0 

0639 


GO TO 40 

0640 

270 

H*AMAXi ( 0 5*H , DXMIN ) 

0641 


DO 2b0 1*1 , N 

0642 

280 

YP<I) = Yld) 

0 643 


GO TO 110 

0644 

300 

KF*IF1X< DX/DXMAX ) 

0645 


H=DX/FLOAT (KF) 

0646 


K=0 

0647 

305 

K =K ♦ 1 

0648 


DO 310 1 = 1 ,N 

0*49 

310 

)0d)*Y(I) 

0650 


CALI. GR<Y,P,X,X0> 

0*51 


X = X*0 5*H 
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DO 320 I«l,N 

0654 


XK ( I , J > «H*P < I ) 

0655 

320 

Y<I>»YO(I)«0.S*XKa,J> 

0656 

330 

CALL GRiY,P,X,X0> 

0657 


X=X+0 S*H 

0658 


DO 340 I«1,N 

0659 


XK<1,3)«H*P(I> 

0660 

340 

Y(I)«Y0(I >+XK(I,3) 

0661 


CALL CR(Y,P,X,X0> 

0662 


DO 350 1-1 ,N 

0663 

350 

Y(X>-Y0<I)+(XK<X ,l)+2 *(XK(I,2)<fXK(I,3))^H*P<I))/6.0 

0664 


IF(K.LT.KF) GO TO 305 

0m65 


X«XF 

0666 


RETURN 

0667 


END 
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0668 SUBROUTINE RHS( X ,XDOT , T,T0 ) 

0669 C a#**###***##*******#**#***####******#*##*##**#*#****#*#**#***#**** 

0670 C THIS SUBROUTINE EVALUATES THE RIGHT HAND SIDE OF THE STATE EQNS. 

0671 C IT IS CALLED FROM NIN. 

0672 C X=CURRENT VALUES OF STATES. 

0673 C XDOT=CURRENT VALUES OF DERIVATIVES OF STATES (SUBROUTINE OUTPUT). 

0674 C T=CURRENT TIME. 

0675 C TO= APPARENTLY NOT USED IN SUBROUTINE. 

0676 C *********)Mt)Mi***************************************************** 

0677 COMMON LL ,PEDL , VW(501 ) , VDC(2001 > ,TBF ,TBR ,BETA(50 1 ) ,C(91 ) , JE ,TAUL ,K 

0678 1CR,BP,KP,KR,MP,MT,MV,RA,RW,KA,KT ,RHO,G,CD,A,W,MU,KG,KPDI,TIMARR(H0 

0679 101) ,DCP,TBMAX,KCEI,KCEP > KPDP ) RSP,RNM1 

0680 COMMON/CC/P IDLE , VVEL 

0681 COMMON/DD/PD 

0682 REAL JE,KA,KCR,KP,KR,KT,MP .MUjHT^VjKGjKPDI ,KCEI ,KCEP ,KPDP 

0683 COMhON/BB/ENGMAP (19,10), ENGSP (19), PEDPCT (10), FUR ATE ( 19,10) , PEDPOS ( 

0684 121 ) ,0PTSP(2i ) ,RTMIN,RTMAX 

0685 DIMENSION X( 15) ,XD0T(1S) 

0686 RLIM=PHI5(X(3) ) 

0687 VVEL»RA*RW*RLIM*X(i) 

0688 PDAL=PEDL 

0689 C LIMIT THROTTLE POSITION. 

0690 IF (PDAL . GT . 100 . 0 ) PDAL=100.0 

0691 IF (PDAL . LT . PIDLE) PDAL*PIDLE 

0692 C COMPUTE BRAKING TORQUE. 

0693 TBR=0 . 0 

0694 IF(PD.LT. PIDLE) TBR=-(PD-PIDLE)*TBMAX 

0695 TBF=TBR 

0696 XDOT ( 1 )=(X(2)-MT#RLIM#(PHIi ( VVEL , VW( 1 ) )+PHI2(TBR ,TBF,BETA( 1 ) M (RA 

0697 i*RW#X(4)*X(i) >) )/(JE+MT*RLlM*RLIM#RA#RW> 

0698 XDOT (2)=-(X(2)-PHI3(PDAL,X(i) ) )/TAUL 

0699 XDOT(3)*X<4) 

0700 JF((X(3) .EQ. RTMAX) .AND . (XDOT (3) . GT . 0 . 0 ) ) XDOT(3>=0.0 

0701 IF( (X(3) EQ.RTMIN) AND. (XD0T(3) LT.0.0)) XDOT(3)=0.0 

0702 XD0T(4)=-(BP*X(4)+KP*RLIM-KR*KG*KCR*(RSP-RLIM))/MP 

0703 RETURN 

0704 END 


FTN4 COMPILER = HP92060-16092 REV. 2026 (800423) 


S* NO WARNING ** NO ERRORS ** PROGRAM ■ 00368 COMMON = 10253 
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0705 REAL FUNCTION PHli vVEL ,VELW> 

0706 C i * 44444444444444444444444444444444444444444444444444444444*****4444 

0707 C THIS FUNCTION HAS A VALUE WHICH CONTAINS THE EFFECTS OF DRAG AND 

0708 C ROLLING RESISTANCE ON THE VEHICLE. IT APPEARS IN THE X3D0T EQN. 

0709 C AND IS CALLED BY RHS . 

0710 C VEL * VEHICLE VELOCITY. 

0711 C VELW=WIND VELOCITY. 

0712 C 444444 * 444 * 44 * 4 * 4444 * 44444444444 * 4 ** 444 *************************** 

0713 COHHON LL,PEDL, VW<501 ) , VDC(2001 ) ,TBF ,TBR , BETA (501 ) ,C<91 ) , JE,TAUL ,K 

0714 1C.R ,BP ,KP ,KR ,MP >HT >MV,RA,RW ,KA,KT ,RHO ,G,CD > A,W ,HU,KG,KPDI ,TIMARR(20 

0715 101) ,DCP,TBHAX,KCE1,KCEP,KPDP,RSP,RNM1 

0716 COHHON/CC/PIDLE ,VVEL 

0717 REAL JEjKA^CRjKP^RjKT^P^U^T^VjKGjKPDI^CEI^CEPjKPDP 

0716 COHHON/AA/I 

0719 C COHPUTE DRAG FORCE. 

0720 DEE=O.S*<RHO/G>4CD*A4< < VEL+VELW)*42> 

0721 I F ( ( VEL+ VEL W ) . LT . 0 . 0 ) DEE»-DEE 

0722 C COMPUTE ROLLING RESISTANCE. 

0723 RR=MU*W* ( 1 . 0+ ( 1 . 4E-3 ) 4VEL+ ( 1 . 2E-5 ) *VEL#VEL ) 

0724 P HI 1 * < R A4R W4 < DEE+RR ) )/<MT4KA4KT) 

0725 RETURN 

0726 END 


FTN4 COMPILER; HP92Q60-16092 REV. 2026 (800423) 

** NO WARNINGS *4 NO ERRORS 4* PROGRAM * 00124 COMMON » 10253 
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0727 REAL FUNCTION PH12(RBT ,FBT , ANGLE ) 

0728 C XXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXX 

0729 C THIS FUNCTION HAS A VALUE WHICH CONTAINS THE EFFECTS OF BRAKING 

0730 C TORQUE AND GRADE ON THE VEHICLE. IT APPEARS IN THE X3D0T EQN . , 

0731 C AND IS CALLED BY RHS . 

0732 C RBT-REAR BRAKING TORQUF (BOTH WHEELS). 

0733 C FBT-FRONT BRAKING TORQUE (BOTH WHEELS). 

0734 C ANGLE -GRADE ANGLE. 

0735 C XXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXX 

0736 COMMON LL,PEDL,VW(501) , VDC(200i ) ,TBF ,TBR , BETA (501 ) ,C(91 ) , JE, TAUL ,K 

0737 ICR, BP ,KP ,KR ,MP ,MT ,MV ,RA,RW,KA,KT ,RHO ,G ,CD , A , W ,MU ,KG ,KPDI ,TIMARR (20 

0738 101 > ,DCP ,TBMAX,KCEI , KCEP ,KPDP ,RSP ,RNM1 

0739 COMMON/CC/PIDLE , VVEL 

0740 REAL JE,KA,KCR,KP ,KR,KT ,MP,MU,MT ,MV ,KG ,KPDI ,KCEI ,KCEP ,KPDP 

0741 COMMON/ AA/ I 

0742 P H 1 2»R AX ( R BT+FBT+R WXWXSI N ( ANGLE ) ) / ( MTXKAXK T ) 

0743 RETURN 

0744 END 


FTN4 COMPILER: HP92060-16092 REV. 2026 (800423) 


«« NO WARNINGS XX 


NO ERRORS XX PROGRAM - 00057 


COMMON * 10253 
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0745 

0746 

0747 

0748 

0749 

0750 

0751 

0752 

0753 

0754 

0755 

0756 

0757 

0758 

0759 

0760 

0761 

0762 

0763 

0764 

0765 

0766 

0767 

0768 

0769 

0770 

0771 

0772 

0773 

0774 

0775 

0776 

0777 

0778 

0779 

0780 

0781 

0782 

0783 

0784 

0785 

0786 

0787 

0788 

0789 

0790 

0791 

0792 

0793 

0794 

0795 


REAL FUNCTION PHI3( PEDAL, ESPEED) 

C THIS FUNCTION EQUALS THE STEADY STATE ENGINE TORQUE DEVELOPED FOR 

C A GIVEN ENGINE SPEED AND PEDAL POSITION. IT IS CALLED BY RHS AND 

C N1N. 

C PEDAL = PEDAL POSITION. 

C ESPEED = ENGINE SPEED. 

C **#****#*#*##**##*##*#*****#**#*#**#*#*##***#*#*#**##*##**#*####** 

COMMON/CC/PIDLE , VVEL 

COMMON/BB/FNGMAP (19,10) ,ENGSP ( 19 ) , PEDPCT ( 10 > ,FURATE( 19 , 10 ) ,PEDPOS< 
121),0PTSP(21),RTMIN,RTMAX 

200 FORMAT <1H0,26HPHI3 ARGUMENT OUT OF RANGE ,5X ,2F10 . 4) 

C SAVE VALUE OF PEDAL 

PLL=PEDAL 

C LIMIT THE PEDAL. 

IF (PEDAL . GT . 100 . 0 ) PEDAL«100.0 
IF (PEDAL. LT.PIDLE) PEDAL*PIDLE 

C FIND THE INDICES OF THE VALUES IN THE ENG. SPEED ARRAY WHICH 
C BRACKET THE ACTUAL ENGINE SPEED. 

IMIN*i 
DO 5 1=1,19 

IF (ESPEED .GE .ENGSP (I ) ) IMIN=I 
IF (ESPEED . LE .ENGSP ( I ) ) GO TO 7 
5 CONTINUE 

7 IMAX=IMIN+1 

IF ( IMAX .GE . 19) IMAX=) 9 

IF ( IMAX . EQ. IhIN) IHIN=IMIN-i 

C FIND THE INDICES OF THE VALUES IN THE PEDAL PERCENT ARRAY WHICH 

C BRACKET THE ACTUAL PEDAL POSITION. 

JMIN=1 

DO 15 J=l,t0 

IF (PEDAL. GE. PEDPCT ( J) ) JhIN=J 
IF (PEDAL . LE .PEDPCT ( J ) ) GO TO 17 
15 CONTINUE 

17 JMAX=JMIN+1 

IF(JMAX.GE.iO) JMAX=10 

IF< JMAX.EQ. JMIN) JNIN=JM1N-1 

C INTERPOLATE TO FIND THE TORQUES CORRESPONDING TO THE BRACKETING 

C VALUES OF PEDAL AND THE ACTUAL ENGINE SPEED. 

22 T LOWP= ( ( ESPEED-ENGSP ( I M I N ) ) 4ENGMAP ( IMAX , JMI N ) + ( ENGSP ( IMAX ) -ESPEED ) 

14ENGMAP ( IHIN, JMIN) >/ (ENGSP ( IMAX ) -ENGSP ( InlN > > 

THIGHP=( (ESPEED-ENGSP ( IhIN ) ) *ENGMAP ( IMAX , JMAX)+ (ENGSP ( IMAX) -ESPEED 
i ) 4ENGMAP ( InlN, JHAX) >/ (ENGSP ( IMAX )- ENGSP ( IHIN) ) 

C INTERPOLATE BETWEEN THE ABOVE TORQUES TO FIND THE TORQUE 

C CORRESPONDING TO THE ACTUAL PEDAL POSITION. 

PHI3=( (PEDAL-PEDPCT (JMIN) )*THIGHP + ( PEDPCT UMAX) -PEDAL )*TLOWP >/(PED 
1PCT ( JMAX ) -PEDPCT ( JMIN ) ) 

C RESTORE VALUE OF PEDAL 

PEDAL=PLL 
RETURN 
END 


FTN4 COMPILER: HP92060-16092 REV. 2026 (800423) 
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0796 REAL FUNCTION PHI4<PEDAL) 

0797 C *********************************************************4*****##* 

0798 C THIS FUNCTION COMPUTES THE ENGINE SPEED SET POINT FOR MIN FUEL 

0799 C CONSUMPTION FOR A GIVEN PEDAL POSITION. IT IS CALLED BY MAIN. 

080 0 C PEDAL * PEDAL POSITION. 

080 1 C ****************************************************************** 


0802 

0803 

0804 

0805 

0806 

0807 

0808 

0809 

0810 
0811 
0812 
0813 
0014 

0815 

0816 

0817 

0818 

0819 

0820 
0821 
0822 
0823 


COrtilON/CC/P IDLE , VVEL 

COMMON/BB/ENGMAP (19,10) ,ENGSP ( 19) ,PEDPCT( 10 ) ,FURATE( 19 , 10 ) ,PEDPOS( 
121 ) ,OPTSP (2l) ,RTMIN,RTMAX 
C LIMIT THE PEDAL.* 

PEDLL*PEDAL 

IFCPEDAL.LT P IDLE) PEDLL=PIDLE 

C FIND THE INDICES OF THE VALUES IN THE PEDAL PERCENT ARRAY WHICH 
C BRACKET THE ACTUAL PEDAL PERCENT. 

IMIN=i 
DO S 1*1,21 

IF (PEDLL . GE . PEDPOSC I ) ) IMIN=I 
IF (PEDLL . LE .PEDPOSd ) ) GO TO 7 
5 CONTINUE 

7 JMAX*IMIN+1 

IF ( I MAX . GE . 21 ) IHAX*2i 

IF ( I MAX . EQ . IMIN) IMIN»IMIN-i 

C INTERPOLATE TO FIND THE ENGINE SPEED SET PT . CORRESPONDING TO THE 
C ACTUAL PEDAL . 

12 PHI4=( (PEDLL-PEDPOS(IMIN) )*OPTSP < IMAX)+<PEDPOS(IMAX)-PEDLL)*OPTSP ( 
ilMIN) )/(PEDPOS(IMAX)-PEDPOS(IMIN) ) 

RETURN 

END 


FTN4 COMPILER: HP92060-1 6092 REV. 2026 (800423) 
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COMMON = 00000 
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0824 REAL FUNCTION PHIS(RHAT) 

OOPS C fc*#****#***#***********#**##*#***#**#*#####*####***###*#####***### 

0826 C THIS FUNCTION LIMITS THE TRANSMISSION RATIO. IT IS CALLED BY 

0R27 C MAIN AND RHS . 

0828 C RHAT*UNLIMITED RATIO VALUE . 

0H29 C *********************«**********«***********«*****»$************** 

0830 COMmON/DB/EN&MAP (19,10), ENGSP ( IV) ,PEDPCT < 10 ) ,FURATE( 19, 10 ) ,PEDPOS( 

0031 121 ) ,OPTSP (21 > ,RTMIN,RTMAX 

0832 PHIS*RHAT 

0833 IF (RTMIN . GT . RHAT ) PHIS=RTMIN 

0834 IF (PHIS . GT . RTMAX) PHI5=RTHAX 

0835 RETURN 

0836 END 


FTN4 COMPILER: HP9206Q-16092 REV. 2026 (800423) 


** NO WARNINGS ** NO ERRORS ** PROGRAM = 00033 COMMON * 00000 
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0837 REAL FUNCTION PHI6(ESPFED , PEDAL ) 

0838 C a***************#***#****#***#**#**#****#**#****#***#****#**#***#* 

0839 C THIS FUNCTION EQUALS THE FUEL CONSUHPTION RATE FOR A GIVEN 

0840 C ENGINE SPEED AND PEDAL POSITION. IT IS CALLED BY MAIN. 

0841 C ESPEED-ENGlNE SPEED PEDAL “PEDAL POSITION. 

0842 C a***##*####***#****####*****##**#***##**** a********##**#####*###** 

0843 COHHON/CC/PIDlE,VVEL 

0844 COrtrtON/BB/ENGHAP (19,10) ,ENGSP C 19) ,PEDPCT (10 ) ,FURATE< 19 , 10 ) ,PEDPOS( 

0845 121 ) ,0PTSP(2l> ,RTHIN,RTHAX 

0846 PEDLL=PEDAL 

0847 C LIHIT PEDAL. 

0848 IF ( PEDAL. LTP IDLE) PEDLL“PIDLE 

0849 C FIND THE INDICES OF THE VALUES IN THE ENGINE SPEED ARRAY WHICH 

0850 C BRACKET THE ACTUAL ENGINE SPEED. 

0851 IHIN“i 

0852 DO 5 I“1 ,19 

0853 IF (ESPEED . GE . ENGSP < I ) ) IHIN^I 

0854 IF(ESPEED . LE . ENGSP ( I ) ) GO TO 7 

0855 5 CONTINUE 

0856 7 IHAX“IHIN+1 

0857 IFdHAX.GE. 19) IMAX*i9 

0858 IFdHAX.EQ. IHIN) IHIN“IHIN-1 

0859 C FIND THE INDICES OF THE VALUES IN THE PEDAL PERCENT ARRAY WHICH 

0860 C BRACKET THE ACTUAL PEDAL PERCENT. 

0861 JHIN“1 

0862 DO 15 J=i , 1 0 

0863 IF<PEDLL.GE.PEDPCT<J)> JHIN=J 

0864 1F(PFDlL.LE.PEDPCT(J)) GO TO 17 

0865 15 CONTINUE 

0866 17 JHAX=JHIN+1 

0867 IFdHAX.GE. 10) JhAX*i0 

0868 IFdHAX.EQ JHIN) JMIN=JHIN-1 

0869 C INTERPOLATE TO FIND THE FUEL RATE CORRESPONDING TO THE BRACKETING 

0870 C VALUES OF ENGINE SPEED AND THE ACTUAL ENGINE SPEED. 

0871 22 F LOWP“ ( ( ESPEED-ENGSP (I HIN ) ) *FIJR ATE ( IHAX , JHIN > + <ENGSP ( IHAX ) -ESPEED ) 

0872 DKFURATE (I HIN, JHIN)) / (ENGSP ( IHAX) -ENGSP (I HIN) ) 

0873 FHIGHP*( ( ESPEED-ENGSP ( IHIN) )*FUR ATE (IHAX, JHAX >+(ENGSP (IHAX )-ESPEED 

0 874 1 ) *FUR ATE (IHIN , JHAX ) ) / ( ENGSP ( IHAX ) -ENGSP (IHIN ) ) 

0875 C INTERPOLATE TO FIND THE FUEL RATE CORRESPONDING TO THE ACTUAL 

0876 C PEDAL POSITION. 

0877 PHI6* < (PEDLL-PEDPCT (JHIN) )*FHIGHP+(PEDPCT ( JHAX)-PEDLL)*FLOWP )/(PED 

0878 1PCT ( JHAX)-PEDPCT(JHIN) ) 

0879 RETURN 

0880 END 


FTN4 COHPILER: HP92060-16092 REV. 2026 (800423) 


** NO WARNINGS ** NO ERRORS ** PROGRAH * 00345 


COnnUN “ ooooo 



PAGE 0(123 FTN. 10:14 Art THU . > 21 MAY 


1981 


- 84 - 


0881 REAL FUNCTION VSP(TIHE) 

0882 C *#**#*****#**##*#####*********#¥****##*****##*** a***************** 

0883 C THIS FUNCTION EQUALS THE DRIVING CYCLE VELOCITY CORRESPONDING TO 

0884 C A GIVEN TIME. IT IS CALLED BY MAIN. 

0885 C TIME*CURRENT TIrtE. VDC<I)«ARRAY OF DRIVING CYCLE 

0886 C VELOCITIES. 

0887 C a***************************************************************** 

0888 COrthON LL»PEDl , VW(S01 > ,VDC(2001 ) ,TBF ,TBR , BETA (SOI) ,C(9i > , JE ,TAUt. ,K 

0889 iCR,BP,KP,KR,rtP,HT jMVjRAjRWjKAjKT ,RHO,&,CD, A ,W,hU,KG,KPBI ,TIHARR < 20 

0890 101) ,DCP > TBhAX > KCEI,KCEP,KPDP > RSP,RNrtl 

0891 COrtHON/CC/P 1 DLE , VVEL 

0892 REAL JE ,KA ,KCR ,KP ,KR ,KT ,HP ,rtU ,HT ,MV,KG,KPDI ,KCEI >KCEP >KPDP 

0893 C FIND THE INDEX OF THE VALUE IN THE TINARR ARRAY WHICH CORRESPONDS 

0894 C TO CURRENT TTrtF . 

08 VS I*IF1X ( TIrtE#RNHi/DCP )+i 

0896 J*I+1 

0897 THlN«TIrtARR<I > 

0898 TrtAX«TIMARR( J) 

0899 C INTERPOLATE TO FIND VELOCITY CORRESPONDING TO CURRENT TIHE. 

0900 VSP*< (TIME-TrtIN)*VDC( J > + (TrtAX“TIHE)*VDC<I) )/< TrtAX-TrtIN ) 

0901 RETURN 

0902 END 


FTN4 COMPILER: HP92060-16092 REV. 2026 (800423) 
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APPENDIX D: ANTI WINDUP ALGORITHM 


Whenever a controller contains an integral term and the 
actuator it is driving can limit (in one or both directions) , 
there is the possibility that the integrator will "wind-up". 

In particular, if the actuator is driven to a limit and the 
error is not zero, the integrator will continue to increase its 
output even though no further reduction in the error is possible. 
If this continues for long enough, the integrator saturates or 
"winds -up". If the error then changes sign (e.g. the set point 
is changed) the actuator will not immediately respond to 
decrease the error because the saturated integrator is keeping 
it at its limit. This type of windup can cause instability and 
precautions must be taken to prevent it. 

A common approach, and the one adopted here, is to prevent 
the integral term from further integration if the actuator is at 
a limit and the error is such that it would tend to windup the 
integrator. Since the controllers used in this work also con- 
tain proportional terms, additional logic is added to account 
for the interaction of these two parts of the control algorithm. 
Finally, because there are slight differences between the 
throttle and engine speed controller logics, a separate flow 
chart for each is included. 
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enter 


Compute new Integral and proportional parts 
of engine speed controller output based on 
current engine speed error. Sum these two 
parts to get new ratio set point. 


Is ratio set point such that it would 
‘cause actual ratio to reach or exceed 
its upper limit? 


Is ratio set point 
such that it would 
cause actual ratio «— 
to reach or go be- 
low its lower limit? 


Will just the proportional part 
of the ratio set point cause the 
actual ratio to reach or exceed 
its upper limit? 


Set integral part of ratio 
set point to a value which 
will produce a ratio set 
point which will put actual 
ratio at its max value. 


Is the change in the 
integrator portion of 
the ratio set point 
such that it will ten3 
to bring the actual 
ratio off the limit? 


Reset integral part of 
ratio set point to old 
value (no change in in- 
tegral part). 


Recompute ratio set point. 


Reset integral part of 
ratio set point to old 
value. 


Set ratio set point 
value which will put 
actual ratio at lower 
limit. 


Figure D1 Engine Speed Controller Anti-Windup Logic 
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ENTER 


Compute new integral and proportional 
parts of throttle controller output 
based on current velocity error. 


Compute new pedal position 
(sum of above terms) 


Is pedal greater than 1002? 


Is proportional part of pedal 
greater than 1002? 


Reset throttle controller 
integrator to old value. 


Set integral portion to 
a value which will pro- 
duce a pedal of 1002. 


Set proportional part to 
a value which will produce 
a pedal of 1002. 


Compute new pedal position. 


EXIT 


